(* Content-type: application/vnd.wolfram.mathematica *)

(*** Wolfram Notebook File ***)
(* http://www.wolfram.com/nb *)

(* CreatedBy='Mathematica 10.0' *)

(*CacheID: 234*)
(* Internal cache information:
NotebookFileLineBreakTest
NotebookFileLineBreakTest
NotebookDataPosition[       158,          7]
NotebookDataLength[    230113,       5367]
NotebookOptionsPosition[    227844,       5319]
NotebookOutlinePosition[    228256,       5337]
CellTagsIndexPosition[    228213,       5334]
WindowFrame->Normal*)

(* Beginning of Notebook Content *)
Notebook[{

Cell[CellGroupData[{
Cell[TextData[StyleBox["ReedsShepp\:51fd\:6570",
 FontFamily->"Times New Roman"]], "Program",
 CellGroupingRules->{"GroupTogetherGrouping", 10000.},
 CellChangeTimes->{{3.701413824828*^9, 3.701413853255*^9}, {3.701413935491*^9,
    3.701414214219*^9}, {3.701415042799*^9, 3.701415082815*^9}, {
   3.701416352468*^9, 3.7014164257720003`*^9}, 3.702693110255*^9, {
   3.702693140474*^9, 3.702693146675*^9}, 3.702696228168*^9, {
   3.7027014152060003`*^9, 3.702701431644*^9}, 3.70270322962*^9, 
   3.7029513588345003`*^9, {3.704958940641*^9, 3.704958941711*^9}, {
   3.790316485361479*^9, 3.7903165073311915`*^9}, {3.7904615215568004`*^9, 
   3.7904615227216854`*^9}, {3.799968163451*^9, 3.79996816423*^9}, 
   3.799998589480119*^9},
 FontSize->16,
 Background->GrayLevel[
  0.85],ExpressionUUID->"cc01d7c5-e572-44e0-b156-551deced11ce"],

Cell[BoxData[{
 RowBox[{
  RowBox[{"lookupTable", "=", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "fwd"}], "}"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"straight", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"right", ",", "bwd"}], "}"}], ",", 
        RowBox[{"{", 
         RowBox[{"left", ",", "fwd"}], "}"}]}], "}"}]}], "}"}], "/.", 
    RowBox[{"{", 
     RowBox[{
      RowBox[{"right", "\[Rule]", "1"}], ",", 
      RowBox[{"left", "\[Rule]", "2"}], ",", 
      RowBox[{"straight", "\[Rule]", "3"}], ",", 
      RowBox[{"fwd", "\[Rule]", "1"}], ",", 
      RowBox[{"bwd", "\[Rule]", 
       RowBox[{"-", "1"}]}]}], "}"}]}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"ArcTan2", "[", 
    RowBox[{"{", 
     RowBox[{"x_", ",", "y_"}], "}"}], "]"}], ":=", 
   RowBox[{"If", "[", 
    RowBox[{
     RowBox[{
      RowBox[{"{", 
       RowBox[{"x", ",", "y"}], "}"}], "==", 
      RowBox[{"{", 
       RowBox[{"0", ",", "0"}], "}"}]}], ",", "0", ",", 
     RowBox[{"ArcTan", "[", 
      RowBox[{"x", ",", "y"}], "]"}]}], "]"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"myatan", "[", 
    RowBox[{"y_", ",", "x_"}], "]"}], ":=", 
   RowBox[{"If", "[", 
    RowBox[{
     RowBox[{
      RowBox[{"{", 
       RowBox[{"x", ",", "y"}], "}"}], "==", 
      RowBox[{"{", 
       RowBox[{"0", ",", "0"}], "}"}]}], ",", "0", ",", 
     RowBox[{"ArcTan", "[", 
      RowBox[{"x", ",", "y"}], "]"}]}], "]"}]}], ";"}], "\n", 
 RowBox[{
  RowBox[{
   RowBox[{"modTo02Pi", "[", "angle_", "]"}], ":=", " ", 
   RowBox[{"Mod", "[", 
    RowBox[{"angle", ",", 
     RowBox[{"2.0", "*", "Pi"}]}], "]"}]}], ";"}], "\n", 
 RowBox[{
  RowBox[{
   RowBox[{"EPSILON", "=", 
    RowBox[{"10", "^", 
     RowBox[{"(", 
      RowBox[{"-", "10"}], ")"}]}]}], ";"}], 
  RowBox[{"(*", "\:8bef\:5dee\:9608\:503c", "*)"}]}], "\n", 
 RowBox[{
  RowBox[{"c1c1c", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=",
   "\n", "   ", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
      "lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], ",", 
    RowBox[{"(*", 
     RowBox[{"t", ",", "u", ",", 
      RowBox[{
      "v\:5c31\:662f\:4e09\:6bb5\:957f\:5ea6", "/", 
       "\:5f27\:5ea6\:7684\:503c"}]}], "*)"}], "\n", "      ", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "-", "rs"}]}], ";", "\n", "      ", 
     RowBox[{"b", "=", 
      RowBox[{"y", "+", "rc"}]}], ";", "\n", "      ", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "a", "]"}], "<", "EPSILON"}], ")"}], "&&", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "b", "]"}], "<", "EPSILON"}], ")"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\n", "      ", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\n", "      ", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], ">", 
        RowBox[{"4", "Rmin"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\n", "      ", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\n", "      ", 
     RowBox[{"\[Alpha]", "=", 
      RowBox[{"ArcCos", "[", 
       RowBox[{"u1", "/", 
        RowBox[{"(", 
         RowBox[{"4", "Rmin"}], ")"}]}], "]"}]}], ";", "\n", "      ", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"Pi", "/", "2"}], "+", "\[Alpha]", "+", "\[Theta]"}], "]"}]}],
      ";", "\n", "      ", 
     RowBox[{"u", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"Pi", "-", 
        RowBox[{"2", "*", "\[Alpha]"}]}], "]"}]}], ";", "\n", "      ", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"\[Phi]", "-", "t", "-", "u"}], "]"}]}], ";", "\n", "      ", 
     RowBox[{"lengthrs", "=", 
      RowBox[{"Rmin", 
       RowBox[{"(", 
        RowBox[{"t", "+", "u", "+", "v"}], ")"}]}]}], ";", "\n", "      ", 
     RowBox[{"Return", "[", 
      RowBox[{"{", 
       RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
     ";"}]}], "\n", "]"}]}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"c1cc", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=",
   "\[IndentingNewLine]", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
      "lengthrs", ",", "result", ",", "t", ",", "u", ",", "v"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "-", "rs"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"b", "=", 
      RowBox[{"y", "+", "rc"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "a", "]"}], "<", "EPSILON"}], ")"}], "&&", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "b", "]"}], "<", "EPSILON"}], ")"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", " ", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], ">", 
        RowBox[{"4", "Rmin"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Alpha]", "=", 
      RowBox[{"ArcCos", "[", 
       RowBox[{"u1", "/", 
        RowBox[{"(", 
         RowBox[{"4", "Rmin"}], ")"}]}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"Pi", "/", "2"}], "+", "\[Alpha]", "+", "\[Theta]"}], "]"}]}],
      ";", "\[IndentingNewLine]", 
     RowBox[{"u", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"Pi", "-", 
        RowBox[{"2", "\[Alpha]"}]}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"t", "+", "u", "-", "\[Phi]"}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"lengthrs", "=", 
      RowBox[{"Rmin", 
       RowBox[{"(", 
        RowBox[{"t", "+", "u", "+", "v"}], ")"}]}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"Return", "[", 
      RowBox[{"{", 
       RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
     ";"}]}], "\n", "]"}]}], "\n", 
 RowBox[{
  RowBox[{"cc1c", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=",
   "\[IndentingNewLine]", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
      "lengthrs", ",", "va", ",", "t", ",", "u", ",", "v"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "-", "rs"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"b", "=", 
      RowBox[{"y", "+", "rc"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", " ", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "a", "]"}], "<", "EPSILON"}], ")"}], "&&", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "b", "]"}], "<", "EPSILON"}], ")"}]}], ",", " ", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", " ", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], ">", 
        RowBox[{"4", "Rmin"}]}], ",", " ", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u", "=", 
      RowBox[{"ArcCos", "[", 
       RowBox[{
        RowBox[{"(", 
         RowBox[{
          RowBox[{"8", 
           RowBox[{"Rmin", "^", "2"}]}], "-", 
          RowBox[{"u1", "^", "2"}]}], ")"}], "/", 
        RowBox[{"(", 
         RowBox[{"8", 
          RowBox[{"Rmin", "^", "2"}]}], ")"}]}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"va", "=", 
      RowBox[{"Sin", "[", "u", "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", " ", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Abs", "[", "va", "]"}], "<", "0.001"}], ",", " ", 
       RowBox[{"va", "=", "0.0"}]}], "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", " ", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "va", "]"}], "<", "0.001"}], ")"}], "&&", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "u1", "]"}], "<", "0.001"}], ")"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Alpha]", "=", 
      RowBox[{"ArcSin", "[", 
       RowBox[{"2", "Rmin", " ", 
        RowBox[{"va", "/", "u1"}]}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"Pi", "/", "2"}], "-", "\[Alpha]", "+", "\[Theta]"}], "]"}]}],
      ";", "\[IndentingNewLine]", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"t", "-", "u", "-", "\[Phi]"}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"lengthrs", "=", 
      RowBox[{"Rmin", "*", 
       RowBox[{"(", 
        RowBox[{"t", "+", "u", "+", "v"}], ")"}]}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"Return", "[", 
      RowBox[{"{", 
       RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
     ";"}]}], "\n", "]"}]}], "\n", 
 RowBox[{
  RowBox[{
   RowBox[{"csca", "[", 
    RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], 
   ":=", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"a", ",", "b", ",", "lengthrs", ",", "t", ",", "u", ",", "v"}], 
      "}"}], ",", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"a", "=", 
       RowBox[{"x", "-", "rs"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"b", "=", 
       RowBox[{"y", "+", "rc"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"t", "=", 
       RowBox[{"modTo02Pi", "[", 
        RowBox[{"myatan", "[", 
         RowBox[{"b", ",", "a"}], "]"}], "]"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"u", "=", 
       RowBox[{"Norm", "[", 
        RowBox[{"{", 
         RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"v", "=", 
       RowBox[{"modTo02Pi", "[", 
        RowBox[{"\[Phi]", "-", "t"}], "]"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"lengthrs", "=", 
       RowBox[{
        RowBox[{"Rmin", "*", 
         RowBox[{"(", 
          RowBox[{"t", "+", "v"}], ")"}]}], "+", " ", "u"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"Return", "[", 
       RowBox[{"{", 
        RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
      ";"}]}], "\n", "]"}]}], ";"}], "\n", 
 RowBox[{" ", 
  RowBox[{
   RowBox[{
    RowBox[{"cscb", "[", 
     RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}],
     ":=", 
    RowBox[{"Module", "[", 
     RowBox[{
      RowBox[{"{", 
       RowBox[{
       "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
        "lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], ",", 
      "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"a", "=", 
        RowBox[{"x", "+", "rs"}]}], ";", "\[IndentingNewLine]", 
       RowBox[{"b", "=", 
        RowBox[{"y", "-", "rc"}]}], ";", "\[IndentingNewLine]", 
       RowBox[{"u1", "=", 
        RowBox[{"Norm", "[", 
         RowBox[{"{", 
          RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
       RowBox[{"If", "[", 
        RowBox[{
         RowBox[{
          RowBox[{"Re", "[", "u1", "]"}], "<", 
          RowBox[{"2", " ", "Rmin"}]}], ",", 
         RowBox[{"Return", "[", 
          RowBox[{"{", 
           RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}],
         "]"}], ";", "\[IndentingNewLine]", 
       RowBox[{"\[Theta]", "=", 
        RowBox[{"myatan", "[", 
         RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
       RowBox[{"u", "=", 
        RowBox[{"Sqrt", "[", 
         RowBox[{
          RowBox[{"u1", "^", "2"}], "-", 
          RowBox[{"4", " ", 
           RowBox[{"Rmin", "^", "2"}]}]}], "]"}]}], ";", 
       "\[IndentingNewLine]", 
       RowBox[{"\[Alpha]", "=", 
        RowBox[{"myatan", "[", 
         RowBox[{
          RowBox[{"2", " ", "Rmin"}], ",", "u"}], "]"}]}], ";", 
       "\[IndentingNewLine]", 
       RowBox[{"t", "=", 
        RowBox[{"modTo02Pi", "[", 
         RowBox[{"\[Theta]", "+", "\[Alpha]"}], "]"}]}], ";", 
       "\[IndentingNewLine]", 
       RowBox[{"v", "=", 
        RowBox[{"modTo02Pi", "[", 
         RowBox[{"t", "-", "\[Phi]"}], "]"}]}], ";", "\[IndentingNewLine]", 
       RowBox[{"lengthrs", "=", 
        RowBox[{
         RowBox[{"Rmin", " ", 
          RowBox[{"(", 
           RowBox[{"t", "+", "v"}], ")"}]}], "+", "u"}]}], ";", 
       "\[IndentingNewLine]", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}]}]}],
      "\[IndentingNewLine]", "]"}]}], ";"}]}], "\n", 
 RowBox[{
  RowBox[{
   RowBox[{"ccu1cuc", "[", 
    RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], 
   ":=", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
      "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
       "lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], ",", "\n", "   ", 
     RowBox[{
      RowBox[{"a", "=", 
       RowBox[{"x", "+", "rs"}]}], ";", "\n", "   ", 
      RowBox[{"b", "=", 
       RowBox[{"y", "-", "rc"}]}], ";", "\n", "   ", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{
         RowBox[{"(", 
          RowBox[{
           RowBox[{"Abs", "[", "a", "]"}], "<", "EPSILON"}], ")"}], "&&", 
         RowBox[{"(", 
          RowBox[{
           RowBox[{"Abs", "[", "b", "]"}], "<", "EPSILON"}], ")"}]}], ",", 
        " ", 
        RowBox[{"Return", "[", 
         RowBox[{"{", 
          RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
       "]"}], ";", "\n", "   ", 
      RowBox[{"u1", "=", 
       RowBox[{"Norm", "[", 
        RowBox[{"{", 
         RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\n", "   ", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{
         RowBox[{"Re", "[", "u1", "]"}], ">", 
         RowBox[{"4", "Rmin"}]}], ",", 
        RowBox[{"Return", "[", 
         RowBox[{"{", 
          RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
       "]"}], ";", "\n", "   ", 
      RowBox[{"\[Theta]", "=", 
       RowBox[{"myatan", "[", 
        RowBox[{"b", ",", "a"}], "]"}]}], ";", "\n", "   ", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{
         RowBox[{"Re", "[", "u1", "]"}], ">", 
         RowBox[{"2", "Rmin"}]}], ",", " ", "\n", "      ", 
        RowBox[{"{", 
         RowBox[{
          RowBox[{"\[Alpha]", "=", 
           RowBox[{"ArcCos", "[", 
            RowBox[{
             RowBox[{"(", 
              RowBox[{
               RowBox[{"u1", "/", "2"}], "-", "Rmin"}], ")"}], "/", 
             RowBox[{"(", 
              RowBox[{"2", "Rmin"}], ")"}]}], "]"}]}], ";", "\n", "      ", 
          RowBox[{"t", "=", 
           RowBox[{"modTo02Pi", "[", 
            RowBox[{
             RowBox[{"Pi", "/", "2"}], "+", "\[Theta]", "-", "\[Alpha]"}], 
            "]"}]}], ";", "\n", "      ", 
          RowBox[{"u", "=", 
           RowBox[{"modTo02Pi", "[", 
            RowBox[{"Pi", "-", "\[Alpha]"}], "]"}]}], ";", "\n", "      ", 
          RowBox[{"v", "=", 
           RowBox[{"modTo02Pi", "[", 
            RowBox[{"\[Phi]", "-", "t", "+", 
             RowBox[{"2", "u"}]}], "]"}]}], ";"}], "}"}], ",", "\n", "      ", 
        RowBox[{"{", 
         RowBox[{
          RowBox[{"\[Alpha]", "=", 
           RowBox[{"ArcCos", "[", 
            RowBox[{
             RowBox[{"(", 
              RowBox[{
               RowBox[{"u1", "/", "2"}], "+", "Rmin"}], ")"}], "/", 
             RowBox[{"(", 
              RowBox[{"2", "Rmin"}], ")"}]}], "]"}]}], ";", "\n", "      ", 
          RowBox[{"t", "=", 
           RowBox[{"modTo02Pi", "[", 
            RowBox[{
             RowBox[{"Pi", "/", "2"}], "+", "\[Theta]", "+", "\[Alpha]"}], 
            "]"}]}], ";", "\n", "      ", 
          RowBox[{"u", "=", 
           RowBox[{"modTo02Pi", "[", "\[Alpha]", "]"}]}], ";", "\n", "      ", 
          RowBox[{"v", "=", 
           RowBox[{"modTo02Pi", "[", 
            RowBox[{"\[Phi]", "-", "t", "+", 
             RowBox[{"2", "u"}]}], "]"}]}], ";"}], "}"}]}], "]"}], ";", "\n", 
      "   ", 
      RowBox[{"lengthrs", "=", 
       RowBox[{"Rmin", "*", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"2", "u"}], "+", "t", "+", "v"}], ")"}]}]}], ";", "\n", 
      "   ", 
      RowBox[{"Return", "[", 
       RowBox[{"{", 
        RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
      ";"}]}], "\n", "]"}]}], ";"}], "\n", 
 RowBox[{
  RowBox[{"c1cucu1c", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
      "lengthrs", ",", "va1", ",", "va2", ",", "t", ",", "u", ",", "v"}], 
     "}"}], ",", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "+", "rs"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"b", "=", 
      RowBox[{"y", "-", "rc"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "a", "]"}], "<", "EPSILON"}], ")"}], "&&", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Abs", "[", "b", "]"}], "<", "EPSILON"}], ")"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], ">", 
        RowBox[{"6", " ", "Rmin"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"va1", "=", 
      RowBox[{
       RowBox[{"(", 
        RowBox[{
         RowBox[{"5", " ", 
          RowBox[{"(", 
           RowBox[{"Rmin", "^", "2"}], ")"}]}], "-", 
         RowBox[{
          RowBox[{"u1", "^", "2"}], "/", "4"}]}], ")"}], "/", 
       RowBox[{"(", 
        RowBox[{"4", " ", 
         RowBox[{"Rmin", "^", "2"}]}], ")"}]}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"(", 
         RowBox[{"va1", "<", "0.0"}], ")"}], "||", 
        RowBox[{"(", 
         RowBox[{"va1", ">", "1.0"}], ")"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"u", "=", 
      RowBox[{"ArcCos", "[", "va1", "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"va2", "=", 
      RowBox[{"Sin", "[", "u", "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Alpha]", "=", 
      RowBox[{"ArcSin", "[", 
       RowBox[{"2", " ", "Rmin", "*", 
        RowBox[{"va2", "/", "u1"}]}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"Pi", "/", "2"}], "+", "\[Theta]", "+", "\[Alpha]"}], "]"}]}],
      ";", "\[IndentingNewLine]", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"t", "-", "\[Phi]"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"lengthrs", "=", 
      RowBox[{"Rmin", " ", 
       RowBox[{"(", 
        RowBox[{
         RowBox[{"2", " ", "u"}], "+", "t", "+", "v"}], ")"}]}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"{", 
      RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}]}]}], 
   "]"}]}], "\n", 
 RowBox[{
  RowBox[{"c1c2sca", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
      "lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], ",", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "-", "rs"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"b", "=", 
      RowBox[{"y", "+", "rc"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], "<", 
        RowBox[{"2", " ", "Rmin"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u", "=", 
      RowBox[{
       RowBox[{"Sqrt", "[", 
        RowBox[{
         RowBox[{"u1", "^", "2"}], "-", 
         RowBox[{"(", 
          RowBox[{"4", " ", 
           RowBox[{"Rmin", "^", "2"}]}], ")"}]}], "]"}], "-", 
       RowBox[{"(", 
        RowBox[{"2", " ", "Rmin"}], ")"}]}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u", "]"}], "<", "0"}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Alpha]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{
        RowBox[{"(", 
         RowBox[{"2", " ", "Rmin"}], ")"}], ",", 
        RowBox[{"(", 
         RowBox[{"u", "+", 
          RowBox[{"2", " ", "Rmin"}]}], ")"}]}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"Pi", "/", "2"}], "+", "\[Theta]", "+", "\[Alpha]"}], "]"}]}],
      ";", "\[IndentingNewLine]", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"t", "+", 
        RowBox[{"Pi", "/", "2"}], "-", "\[Phi]"}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"lengthrs", "=", 
      RowBox[{
       RowBox[{"Rmin", "*", 
        RowBox[{"(", 
         RowBox[{"t", "+", 
          RowBox[{"Pi", "/", "2"}], "+", "v"}], ")"}]}], "+", "u"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"{", 
      RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}]}]}], 
   "\[IndentingNewLine]", "]"}]}], "\n", 
 RowBox[{
  RowBox[{"c1c2scb", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "lengthrs", ",", "t", 
      ",", "u", ",", "v"}], "}"}], ",", "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "+", "rs"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"b", "=", 
      RowBox[{"y", "-", "rc"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], "<", 
        RowBox[{"2", "Rmin"}]}], ",", " ", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"Pi", "/", "2"}], "+", "\[Theta]"}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"u", "=", 
      RowBox[{"u1", "-", 
       RowBox[{"2", "Rmin"}]}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"\[Phi]", "-", "t", "-", 
        RowBox[{"Pi", "/", "2"}]}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"lengthrs", "=", 
      RowBox[{
       RowBox[{"Rmin", " ", 
        RowBox[{"(", 
         RowBox[{"t", "+", 
          RowBox[{"Pi", "/", "2"}], "+", "v"}], ")"}]}], "+", " ", "u"}]}], 
     ";", "\[IndentingNewLine]", 
     RowBox[{"Return", "[", 
      RowBox[{"{", 
       RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
     ";"}]}], "\n", "]"}]}], "\n", 
 RowBox[{
  RowBox[{"c1c2sc21c", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
      "lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "+", "rs"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"b", "=", 
      RowBox[{"y", "-", "rc"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], "<", 
        RowBox[{"4", "Rmin"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u", "=", 
      RowBox[{
       RowBox[{"Sqrt", "[", 
        RowBox[{
         RowBox[{"u1", "^", "2"}], "-", 
         RowBox[{"(", 
          RowBox[{"4", 
           RowBox[{"Rmin", "^", "2"}]}], ")"}]}], "]"}], "-", 
       RowBox[{"(", 
        RowBox[{"4", "Rmin"}], ")"}]}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u", "]"}], "<", "0.0"}], ",", " ", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Alpha]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{
        RowBox[{"2", "Rmin"}], ",", 
        RowBox[{"(", 
         RowBox[{"u", "+", 
          RowBox[{"4", "Rmin"}]}], ")"}]}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"Pi", "/", "2"}], "+", "\[Theta]", "+", "\[Alpha]"}], "]"}]}],
      ";", "\[IndentingNewLine]", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"t", "-", "\[Phi]"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"lengthrs", "=", 
      RowBox[{
       RowBox[{"Rmin", "*", 
        RowBox[{"(", 
         RowBox[{"t", "+", "Pi", "+", "v"}], ")"}]}], "+", "u"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"Return", "[", 
      RowBox[{"{", 
       RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
     ";"}]}], "\n", "]"}]}], "\n", 
 RowBox[{
  RowBox[{"csc21ca", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
      "lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "-", "rs"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"b", "=", 
      RowBox[{"y", "+", "rc"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], "<", 
        RowBox[{"2", "Rmin"}]}], " ", ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u", "=", 
      RowBox[{
       RowBox[{"Sqrt", "[", 
        RowBox[{
         RowBox[{"u1", "^", "2"}], "-", 
         RowBox[{"(", 
          RowBox[{"4", 
           RowBox[{"Rmin", "^", "2"}]}], ")"}]}], "]"}], "-", 
       RowBox[{"2", "Rmin"}]}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u", "]"}], "<", "0"}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Alpha]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{
        RowBox[{"(", 
         RowBox[{"u", "+", 
          RowBox[{"2", "Rmin"}]}], ")"}], ",", 
        RowBox[{"2", "Rmin"}]}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"Pi", "/", "2"}], "+", "\[Theta]", "-", "\[Alpha]"}], "]"}]}],
      ";", "\[IndentingNewLine]", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{"t", "-", 
        RowBox[{"Pi", "/", "2"}], "-", "\[Phi]"}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"lengthrs", "=", 
      RowBox[{
       RowBox[{"Rmin", "*", 
        RowBox[{"(", 
         RowBox[{"t", "+", 
          RowBox[{"Pi", "/", "2"}], "+", "v"}], ")"}]}], "+", "u"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"Return", "[", 
      RowBox[{"{", 
       RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
     ";"}]}], "\n", "]"}]}], "\n", 
 RowBox[{
  RowBox[{"csc21cb", "[", 
   RowBox[{"x_", ",", "y_", ",", "\[Phi]_", ",", "rs_", ",", "rc_"}], "]"}], ":=", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
     "a", ",", "b", ",", "u1", ",", "\[Theta]", ",", "\[Alpha]", ",", 
      "lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], ",", 
    "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"a", "=", 
      RowBox[{"x", "+", "rs"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"b", "=", 
      RowBox[{"y", "-", "rc"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"u1", "=", 
      RowBox[{"Norm", "[", 
       RowBox[{"{", 
        RowBox[{"a", ",", "b"}], "}"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"If", " ", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"Re", "[", "u1", "]"}], "<", 
        RowBox[{"2", "Rmin"}]}], ",", 
       RowBox[{"Return", "[", 
        RowBox[{"{", 
         RowBox[{"Infinity", ",", "0", ",", "0", ",", "0"}], "}"}], "]"}]}], 
      "]"}], ";", "\[IndentingNewLine]", 
     RowBox[{"\[Theta]", "=", 
      RowBox[{"myatan", "[", 
       RowBox[{"b", ",", "a"}], "]"}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"t", "=", 
      RowBox[{"modTo02Pi", "[", "\[Theta]", "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"u", "=", 
      RowBox[{"u1", "-", 
       RowBox[{"2", "Rmin"}]}]}], ";", "\[IndentingNewLine]", 
     RowBox[{"v", "=", 
      RowBox[{"modTo02Pi", "[", 
       RowBox[{
        RowBox[{"-", "t"}], "-", 
        RowBox[{"Pi", "/", "2"}], "+", "\[Phi]"}], "]"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"lengthrs", "=", 
      RowBox[{
       RowBox[{"Rmin", 
        RowBox[{"(", 
         RowBox[{"t", "+", 
          RowBox[{"Pi", "/", "2"}], "+", "v"}], ")"}]}], "+", "u"}]}], ";", 
     "\[IndentingNewLine]", 
     RowBox[{"Return", "[", 
      RowBox[{"{", 
       RowBox[{"lengthrs", ",", "t", ",", "u", ",", "v"}], "}"}], "]"}], 
     ";"}]}], "\n", "]"}]}], "\n", 
 RowBox[{
  RowBox[{
   RowBox[{"ReedShepp", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"x1_", ",", " ", "y1_", ",", " ", "t1_"}], "}"}], ",", " ", 
     RowBox[{"{", 
      RowBox[{"x2_", ",", " ", "y2_", ",", " ", "t2_"}], "}"}]}], "]"}], ":=", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
      "x", ",", "y", ",", "\[Phi]", ",", " ", "vard", ",", "\[Theta]", ",", 
       "\[Alpha]", ",", "dx", ",", "dy", ",", " ", "ap", ",", "am", ",", "b1",
        ",", "b2", ",", "lengths", ",", "minLength", ",", "RS1s", ",", "RS2s",
        ",", "RS3s"}], "}"}], ",", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{
       RowBox[{"{", 
        RowBox[{"dx", ",", "dy"}], "}"}], "=", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"x2", ",", "y2"}], "}"}], "-", 
        RowBox[{"{", 
         RowBox[{"x1", ",", "y1"}], "}"}]}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"\[Theta]", "=", 
       RowBox[{"myatan", "[", 
        RowBox[{"dy", ",", "dx"}], "]"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"\[Alpha]", "=", 
       RowBox[{"\[Theta]", "-", "t1"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"vard", "=", 
       RowBox[{"Norm", "[", 
        RowBox[{"{", 
         RowBox[{"dx", ",", "dy"}], "}"}], "]"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"x", ",", "y"}], "}"}], "=", 
       RowBox[{"vard", "*", 
        RowBox[{"AngleVector", "[", "\[Alpha]", "]"}]}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"\[Phi]", "=", 
       RowBox[{"t2", "-", "t1"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"ap", ",", "am"}], "}"}], "=", 
       RowBox[{
        RowBox[{"Sin", "[", "\[Phi]", "]"}], "*", 
        RowBox[{"{", 
         RowBox[{"Rmin", ",", 
          RowBox[{"-", "Rmin"}]}], "}"}]}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"b1", "=", 
       RowBox[{"Rmin", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Cos", "[", "\[Phi]", "]"}], "-", "1"}], ")"}]}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"b2", "=", 
       RowBox[{"Rmin", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Cos", "[", "\[Phi]", "]"}], "+", "1"}], ")"}]}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"lengths", ",", "RS1s", ",", "RS2s", ",", "RS3s"}], "}"}], 
       "=", 
       RowBox[{"Transpose", "@", 
        RowBox[{"{", 
         RowBox[{
          RowBox[{"c1c1c", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], 
           "]"}], ",", 
          RowBox[{"{", 
           RowBox[{
           "Infinity", ",", "Infinity", ",", "Infinity", ",", "Infinity"}], 
           "}"}], ",", 
          RowBox[{"c1c1c", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"{", 
           RowBox[{
           "Infinity", ",", "Infinity", ",", "Infinity", ",", "Infinity"}], 
           "}"}], ",", 
          RowBox[{"c1cc", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], 
           "]"}], ",", 
          RowBox[{"c1cc", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"c1cc", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"c1cc", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
          ",", 
          RowBox[{"csca", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], 
           "]"}], ",", 
          RowBox[{"csca", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"csca", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"csca", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
          ",", 
          RowBox[{"cscb", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], 
           "]"}], ",", 
          RowBox[{"cscb", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"cscb", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"cscb", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
          ",", 
          RowBox[{"ccu1cuc", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], 
           "]"}], ",", 
          RowBox[{"ccu1cuc", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"ccu1cuc", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"ccu1cuc", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
          ",", 
          RowBox[{"c1cucu1c", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], 
           "]"}], ",", 
          RowBox[{"c1cucu1c", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"c1cucu1c", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"c1cucu1c", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
          ",", 
          RowBox[{"c1c2sca", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], 
           "]"}], ",", 
          RowBox[{"c1c2sca", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"c1c2sca", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"c1c2sca", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
          ",", 
          RowBox[{"c1c2scb", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], 
           "]"}], ",", 
          RowBox[{"c1c2scb", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"c1c2scb", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"c1c2scb", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
          ",", 
          RowBox[{"c1c2sc21c", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], 
           "]"}], ",", 
          RowBox[{"c1c2sc21c", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"c1c2sc21c", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"c1c2sc21c", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
          ",", 
          RowBox[{"cc1c", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], 
           "]"}], ",", 
          RowBox[{"cc1c", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"cc1c", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"cc1c", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
          ",", 
          RowBox[{"csc21ca", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], 
           "]"}], ",", 
          RowBox[{"csc21ca", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"csc21ca", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
          RowBox[{"csc21ca", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
          ",", 
          RowBox[{"csc21cb", "[", 
           RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], 
           "]"}], ",", 
          RowBox[{"csc21cb", "[", 
           RowBox[{"x", ",", 
            RowBox[{"-", "y"}], ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"csc21cb", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", "y", ",", 
            RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
          RowBox[{"csc21cb", "[", 
           RowBox[{
            RowBox[{"-", "x"}], ",", 
            RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], 
           "]"}]}], "}"}]}]}], ";", "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", "num", "}"}], "=", 
       RowBox[{"FirstPosition", "[", 
        RowBox[{"lengths", ",", 
         RowBox[{"Min", "[", "lengths", "]"}]}], "]"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"minLength", ",", "RSl1", ",", "RSl2", ",", "RSl3"}], "}"}], 
       "=", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"lengths", ",", "RS1s", ",", "RS2s", ",", "RS3s"}], "}"}], 
        "\[LeftDoubleBracket]", 
        RowBox[{";;", ",", "num"}], "\[RightDoubleBracket]"}]}], ";", 
      "\[IndentingNewLine]", "minLength"}]}], "\n", "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"ReedSheppMulti", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"x1_", ",", " ", "y1_", ",", " ", "t1_"}], "}"}], ",", " ", 
     RowBox[{"{", 
      RowBox[{"x2_", ",", " ", "y2_", ",", " ", "t2_"}], "}"}]}], "]"}], ":=", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
      "x", ",", "y", ",", "\[Phi]", ",", " ", "vard", ",", "\[Theta]", ",", 
       "\[Alpha]", ",", "dx", ",", "dy", ",", " ", "ap", ",", "am", ",", "b1",
        ",", "b2", ",", 
       RowBox[{"(*", 
        RowBox[{"lengths", ","}], "*)"}], "minLength", ",", "RSs"}], "}"}], 
     ",", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{
       RowBox[{"{", 
        RowBox[{"dx", ",", "dy"}], "}"}], "=", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{"x2", ",", "y2"}], "}"}], "-", 
        RowBox[{"{", 
         RowBox[{"x1", ",", "y1"}], "}"}]}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"\[Theta]", "=", 
       RowBox[{"myatan", "[", 
        RowBox[{"dy", ",", "dx"}], "]"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"\[Alpha]", "=", 
       RowBox[{"\[Theta]", "-", "t1"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"vard", "=", 
       RowBox[{"Norm", "[", 
        RowBox[{"{", 
         RowBox[{"dx", ",", "dy"}], "}"}], "]"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"x", ",", "y"}], "}"}], "=", 
       RowBox[{"vard", "*", 
        RowBox[{"AngleVector", "[", "\[Alpha]", "]"}]}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"\[Phi]", "=", 
       RowBox[{"t2", "-", "t1"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"ap", ",", "am"}], "}"}], "=", 
       RowBox[{
        RowBox[{"Sin", "[", "\[Phi]", "]"}], "*", 
        RowBox[{"{", 
         RowBox[{"Rmin", ",", 
          RowBox[{"-", "Rmin"}]}], "}"}]}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"b1", "=", 
       RowBox[{"Rmin", "*", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Cos", "[", "\[Phi]", "]"}], "-", "1"}], ")"}]}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"b2", "=", 
       RowBox[{"Rmin", "*", 
        RowBox[{"(", 
         RowBox[{
          RowBox[{"Cos", "[", "\[Phi]", "]"}], "+", "1"}], ")"}]}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"RSs", "=", 
       RowBox[{"{", 
        RowBox[{
         RowBox[{"c1c1c", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}],
          ",", 
         RowBox[{"{", 
          RowBox[{
          "Infinity", ",", "Infinity", ",", "Infinity", ",", "Infinity"}], 
          "}"}], ",", 
         RowBox[{"c1c1c", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"{", 
          RowBox[{
          "Infinity", ",", "Infinity", ",", "Infinity", ",", "Infinity"}], 
          "}"}], ",", 
         RowBox[{"c1cc", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}],
          ",", 
         RowBox[{"c1cc", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"c1cc", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"c1cc", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
         ",", 
         RowBox[{"csca", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}],
          ",", 
         RowBox[{"csca", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"csca", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"csca", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
         ",", 
         RowBox[{"cscb", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}],
          ",", 
         RowBox[{"cscb", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"cscb", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"cscb", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
         ",", 
         RowBox[{"ccu1cuc", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}],
          ",", 
         RowBox[{"ccu1cuc", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"ccu1cuc", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"ccu1cuc", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
         ",", 
         RowBox[{"c1cucu1c", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}],
          ",", 
         RowBox[{"c1cucu1c", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"c1cucu1c", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"c1cucu1c", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
         ",", 
         RowBox[{"c1c2sca", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}],
          ",", 
         RowBox[{"c1c2sca", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"c1c2sca", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"c1c2sca", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
         ",", 
         RowBox[{"c1c2scb", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}],
          ",", 
         RowBox[{"c1c2scb", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"c1c2scb", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"c1c2scb", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
         ",", 
         RowBox[{"c1c2sc21c", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}],
          ",", 
         RowBox[{"c1c2sc21c", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"c1c2sc21c", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"c1c2sc21c", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}], 
         ",", 
         RowBox[{"cc1c", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}],
          ",", 
         RowBox[{"cc1c", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"cc1c", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"cc1c", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
         ",", 
         RowBox[{"csc21ca", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}],
          ",", 
         RowBox[{"csc21ca", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"csc21ca", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b1"}], "]"}], ",", 
         RowBox[{"csc21ca", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b1"}], "]"}], 
         ",", 
         RowBox[{"csc21cb", "[", 
          RowBox[{"x", ",", "y", ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}],
          ",", 
         RowBox[{"csc21cb", "[", 
          RowBox[{"x", ",", 
           RowBox[{"-", "y"}], ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"csc21cb", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", "y", ",", 
           RowBox[{"-", "\[Phi]"}], ",", "am", ",", "b2"}], "]"}], ",", 
         RowBox[{"csc21cb", "[", 
          RowBox[{
           RowBox[{"-", "x"}], ",", 
           RowBox[{"-", "y"}], ",", "\[Phi]", ",", "ap", ",", "b2"}], "]"}]}],
         "}"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"Table", "[", 
       RowBox[{
        RowBox[{"If", "[", 
         RowBox[{
          RowBox[{
           RowBox[{"i", "\[Equal]", "2"}], "||", 
           RowBox[{"i", "\[Equal]", "4"}], "||", 
           RowBox[{"i", "\[Equal]", "num"}]}], ",", "Nothing", ",", 
          RowBox[{
           RowBox[{"constRS", "[", 
            RowBox[{"i", ",", 
             RowBox[{"RSs", "\[LeftDoubleBracket]", 
              RowBox[{"i", ",", 
               RowBox[{"2", ";;", "4"}]}], "\[RightDoubleBracket]"}], ",", 
             "start", ",", "stepSize"}], "]"}], ";", 
           RowBox[{"poses", "\[LeftDoubleBracket]", 
            RowBox[{";;", ",", 
             RowBox[{"1", ";;", "2"}]}], "\[RightDoubleBracket]"}]}]}], "]"}],
         ",", 
        RowBox[{"{", 
         RowBox[{"i", ",", "48"}], "}"}]}], "]"}]}]}], "\n", "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"fctcurve", "[", 
    RowBox[{
    "type_", ",", "sign_", ",", "val_", ",", "x1_", ",", "y1_", ",", "t1_", 
     ",", "deltat_", ",", "nn_"}], "]"}], ":=", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
      "pose", ",", "i", ",", "va1", ",", "va2", ",", "l", ",", "newval", ",", 
       "incrt", ",", "remain", ",", "centerx", ",", "centery", ",", "x2", ",",
        "y2", ",", "t2", ",", "nnew", ",", "n", ",", "segment1", ",", 
       "segment2", ",", "segment3"}], "}"}], ",", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"n", "=", "nn"}], ";", "\[IndentingNewLine]", 
      RowBox[{"delta", "=", "deltat"}], ";", "\[IndentingNewLine]", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{"type", "==", "3"}], ",", " ", 
        RowBox[{"If", "[", 
         RowBox[{
          RowBox[{
           RowBox[{"Abs", "[", 
            RowBox[{"val", "/", "Rmin"}], "]"}], "<", "EPSILON"}], ",", " ", 
          RowBox[{"Return", "[", "0.0", "]"}]}], "]"}], ",", 
        RowBox[{"If", "[", 
         RowBox[{
          RowBox[{
           RowBox[{"Abs", "[", "val", "]"}], "<", "EPSILON"}], " ", ",", " ", 
          RowBox[{"Return", "[", "0.0", "]"}]}], "]"}]}], "]"}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"Switch", "[", 
       RowBox[{"type", ",", "\[IndentingNewLine]", "1", ",", 
        RowBox[{"(*", 
         RowBox[{"right", " ", "arc"}], "*)"}], "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{"delta", "=", 
          RowBox[{"delta", "/", "Rmin"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"{", 
          RowBox[{
           RowBox[{"centerx", "=", " ", 
            RowBox[{"x1", "+", 
             RowBox[{"Rmin", "*", 
              RowBox[{"Sin", "[", "t1", "]"}]}]}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"centery", "=", " ", 
            RowBox[{"y1", "-", 
             RowBox[{"Rmin", "*", 
              RowBox[{"Cos", "[", "t1", "]"}]}]}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"va1", "=", " ", 
            RowBox[{"t1", "+", 
             RowBox[{"Pi", "/", "2"}]}]}], ";", "\[IndentingNewLine]", 
           RowBox[{"If", " ", "[", 
            RowBox[{
             RowBox[{"sign", "==", "1"}], ",", 
             RowBox[{"va2", "=", 
              RowBox[{"va1", "-", "val"}]}], ",", 
             RowBox[{"va2", "=", 
              RowBox[{"va1", "+", "val"}]}]}], "]"}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"x2", "=", 
            RowBox[{"centerx", "+", 
             RowBox[{"Rmin", "*", 
              RowBox[{"Cos", "[", "va2", "]"}]}]}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"y2", "=", 
            RowBox[{"centery", "+", 
             RowBox[{"Rmin", "*", 
              RowBox[{"Sin", "[", "va2", "]"}]}]}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"t2", "=", " ", 
            RowBox[{"t1", "-", 
             RowBox[{"sign", "*", "val"}]}]}], ";", "\[IndentingNewLine]", 
           RowBox[{"nnew", "=", 
            RowBox[{"Round", "[", 
             RowBox[{"val", "/", "delta"}], "]"}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"remain", "=", 
            RowBox[{"val", "-", 
             RowBox[{"nnew", "*", "delta"}]}]}], ";", "\[IndentingNewLine]", 
           RowBox[{"nnew", "=", 
            RowBox[{"nnew", "+", "n"}]}], ";", "\[IndentingNewLine]", 
           RowBox[{"If", " ", "[", 
            RowBox[{
             RowBox[{"sign", "==", 
              RowBox[{"-", "1"}]}], ",", 
             RowBox[{"delta", "=", 
              RowBox[{"-", "delta"}]}]}], "]"}], ";", "\[IndentingNewLine]", 
           RowBox[{"incrt", "=", "0"}], ";", "\[IndentingNewLine]", 
           RowBox[{"segment1", "=", 
            RowBox[{"Table", " ", "[", 
             RowBox[{
              RowBox[{
               RowBox[{"va1", "=", 
                RowBox[{"va1", "-", "delta"}]}], ";", " ", 
               RowBox[{"incrt", "=", 
                RowBox[{"incrt", "-", "delta"}]}], ";", " ", 
               RowBox[{"{", 
                RowBox[{
                 RowBox[{"centerx", "+", 
                  RowBox[{"Rmin", "*", 
                   RowBox[{"Cos", "[", "va1", "]"}]}]}], ",", 
                 RowBox[{"centery", "+", 
                  RowBox[{"Rmin", "*", 
                   RowBox[{"Sin", "[", "va1", "]"}]}]}], ",", 
                 RowBox[{"modTo02Pi", "[", 
                  RowBox[{"t1", "+", "incrt"}], "]"}]}], "}"}]}], ",", 
              RowBox[{"{", 
               RowBox[{"i", ",", "n", ",", 
                RowBox[{"nnew", "-", "1"}]}], "}"}]}], "]"}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"poses", "=", 
            RowBox[{"poses", "~", "Join", "~", "segment1"}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"n", "=", "nnew"}], ";"}], "\[IndentingNewLine]", " ", 
          "}"}]}], ",", "\[IndentingNewLine]", "2", ",", 
        RowBox[{"(*", 
         RowBox[{"left", " ", "arc"}], "*)"}], "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{"delta", "=", 
          RowBox[{"delta", "/", "Rmin"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"{", 
          RowBox[{
           RowBox[{"centerx", "=", " ", 
            RowBox[{"x1", "-", 
             RowBox[{"Rmin", "*", 
              RowBox[{"Sin", "[", "t1", "]"}]}]}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"centery", "=", " ", 
            RowBox[{"y1", "+", 
             RowBox[{"Rmin", "*", 
              RowBox[{"Cos", "[", "t1", "]"}]}]}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"va1", "=", " ", 
            RowBox[{"t1", "-", 
             RowBox[{"Pi", "/", "2"}]}]}], ";", "\[IndentingNewLine]", 
           RowBox[{"If", " ", "[", 
            RowBox[{
             RowBox[{"sign", "==", "1"}], ",", " ", 
             RowBox[{"va2", "=", 
              RowBox[{"va1", "+", "val"}]}], ",", 
             RowBox[{"va2", "=", 
              RowBox[{"va1", "-", "val"}]}]}], "]"}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"x2", "=", 
            RowBox[{"centerx", "+", 
             RowBox[{"Rmin", "*", 
              RowBox[{"Cos", "[", "va2", "]"}]}]}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"y2", "=", 
            RowBox[{"centery", "+", 
             RowBox[{"Rmin", "*", 
              RowBox[{"Sin", "[", "va2", "]"}]}]}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"t2", "=", " ", 
            RowBox[{"t1", "+", 
             RowBox[{"sign", "*", "val"}]}]}], ";", "\[IndentingNewLine]", 
           RowBox[{"nnew", "=", 
            RowBox[{"Round", "[", 
             RowBox[{"val", "/", "delta"}], "]"}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"remain", "=", 
            RowBox[{"val", "-", 
             RowBox[{"nnew", "*", "delta"}]}]}], ";", "\[IndentingNewLine]", 
           RowBox[{"nnew", "=", 
            RowBox[{"nnew", "+", "n"}]}], ";", "\[IndentingNewLine]", 
           RowBox[{"If", " ", "[", 
            RowBox[{
             RowBox[{"sign", "==", 
              RowBox[{"-", "1"}]}], ",", 
             RowBox[{"delta", "=", 
              RowBox[{"-", "delta"}]}]}], "]"}], ";", "\[IndentingNewLine]", 
           RowBox[{"incrt", "=", "0"}], ";", "\[IndentingNewLine]", 
           RowBox[{"segment2", "=", 
            RowBox[{"Table", " ", "[", 
             RowBox[{
              RowBox[{
               RowBox[{"va1", "=", 
                RowBox[{"va1", "+", "delta"}]}], ";", " ", 
               RowBox[{"incrt", "=", 
                RowBox[{"incrt", "+", "delta"}]}], ";", " ", 
               RowBox[{"{", 
                RowBox[{
                 RowBox[{"centerx", "+", 
                  RowBox[{"Rmin", "*", 
                   RowBox[{"Cos", "[", "va1", "]"}]}]}], ",", 
                 RowBox[{"centery", "+", 
                  RowBox[{"Rmin", "*", 
                   RowBox[{"Sin", "[", "va1", "]"}]}]}], ",", 
                 RowBox[{"modTo02Pi", "[", 
                  RowBox[{"t1", "+", "incrt"}], "]"}]}], "}"}]}], ",", 
              RowBox[{"{", 
               RowBox[{"i", ",", "n", ",", 
                RowBox[{"nnew", "-", "1"}]}], "}"}]}], "]"}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"poses", "=", 
            RowBox[{"poses", "~", "Join", "~", "segment2"}]}], ";", 
           "\[IndentingNewLine]", 
           RowBox[{"n", "=", "nnew"}], ";"}], "\[IndentingNewLine]", "}"}]}], 
        ",", "\[IndentingNewLine]", "3", ",", 
        RowBox[{"(*", 
         RowBox[{"straight", " ", "line"}], "*)"}], "\[IndentingNewLine]", 
        RowBox[{"{", 
         RowBox[{
          RowBox[{"x2", "=", 
           RowBox[{"x1", "+", 
            RowBox[{"sign", "*", "val", "*", 
             RowBox[{"Cos", "[", "t1", "]"}]}]}]}], ";", 
          "\[IndentingNewLine]", 
          RowBox[{"y2", "=", 
           RowBox[{"y1", "+", 
            RowBox[{"sign", "*", "val", "*", 
             RowBox[{"Sin", "[", "t1", "]"}]}]}]}], ";", 
          "\[IndentingNewLine]", 
          RowBox[{"t2", "=", 
           RowBox[{"modToPiPi", "[", "t1", "]"}]}], ";", 
          "\[IndentingNewLine]", 
          RowBox[{"va1", "=", 
           RowBox[{"Norm", "[", 
            RowBox[{
             RowBox[{"{", 
              RowBox[{"x2", ",", "y2"}], "}"}], "-", 
             RowBox[{"{", 
              RowBox[{"x1", ",", "y1"}], "}"}]}], "]"}]}], ";", 
          "\[IndentingNewLine]", 
          RowBox[{"nnew", "=", 
           RowBox[{"n", "+", 
            RowBox[{"va1", "/", "delta"}]}]}], ";", "\[IndentingNewLine]", 
          RowBox[{"newval", "=", "delta"}], ";", "\[IndentingNewLine]", 
          RowBox[{"va1", "=", 
           RowBox[{"sign", "*", 
            RowBox[{"Cos", "[", "t2", "]"}]}]}], ";", "\[IndentingNewLine]", 
          RowBox[{"va2", "=", 
           RowBox[{"sign", "*", 
            RowBox[{"Sin", "[", "t2", "]"}]}]}], ";", "\[IndentingNewLine]", 
          RowBox[{"segment3", "=", 
           RowBox[{"Table", "[", 
            RowBox[{
             RowBox[{
              RowBox[{"pose", "=", 
               RowBox[{"{", 
                RowBox[{
                 RowBox[{"x1", "+", 
                  RowBox[{"va1", "*", "newval"}]}], ",", 
                 RowBox[{"y1", "+", 
                  RowBox[{"va2", "*", "newval"}]}], ",", "t2"}], "}"}]}], ";", 
              RowBox[{"newval", "=", 
               RowBox[{"newval", "+", "delta"}]}], ";", "pose"}], ",", 
             RowBox[{"{", 
              RowBox[{"i", ",", "n", ",", 
               RowBox[{"nnew", "-", "1"}]}], "}"}]}], "]"}]}], ";", 
          "\[IndentingNewLine]", 
          RowBox[{"poses", "=", 
           RowBox[{"poses", "~", "Join", "~", "segment3"}]}], ";"}], "}"}]}], 
       "\[IndentingNewLine]", " ", "]"}], ";", "\[IndentingNewLine]", 
      RowBox[{"Return", "[", 
       RowBox[{"{", 
        RowBox[{"n", ",", "x2", ",", "y2", ",", "t2"}], "}"}], "]"}], ";"}]}],
     "\n", "]"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"constRS", "[", 
    RowBox[{"num_", ",", 
     RowBox[{"{", 
      RowBox[{"RS1_", ",", " ", "RS2_", ",", " ", "RS3_"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"xs_", ",", " ", "ys_", ",", " ", "\[Theta]s_"}], "}"}], ",", 
     " ", "delta_"}], "]"}], ":=", "\n", "     ", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
      "n", ",", "right", ",", "left", ",", "straight", ",", "fwd", ",", "bwd",
        ",", "x1", ",", "y1", ",", "t1", ",", "RSl1", ",", "RSl2", ",", 
       "RSl3"}], "}"}], ",", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"n", "=", "1"}], ";", 
      RowBox[{"right", "=", "1"}], ";", 
      RowBox[{"left", "=", "2"}], ";", 
      RowBox[{"straight", "=", "3"}], ";", 
      RowBox[{"fwd", "=", "1"}], ";", 
      RowBox[{"bwd", "=", 
       RowBox[{"-", "1"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"x1", ",", "y1", ",", "t1"}], "}"}], "=", 
       RowBox[{"{", 
        RowBox[{"xs", ",", "ys", ",", "\[Theta]s"}], "}"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{"RS1", "<", "EPSILON"}], ",", 
        RowBox[{"RSl1", "=", 
         RowBox[{"100", "EPSILON"}]}], ",", 
        RowBox[{"RSl1", "=", "RS1"}]}], "]"}], ";", "\[IndentingNewLine]", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{"RS2", "<", "EPSILON"}], ",", 
        RowBox[{"RSl2", "=", 
         RowBox[{"100", "EPSILON"}]}], ",", 
        RowBox[{"RSl2", "=", "RS2"}]}], "]"}], ";", "\[IndentingNewLine]", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{"RS3", "<", "EPSILON"}], ",", 
        RowBox[{"RSl3", "=", 
         RowBox[{"100", "EPSILON"}]}], ",", 
        RowBox[{"RSl3", "=", "RS3"}]}], "]"}], ";", "\[IndentingNewLine]", 
      RowBox[{"(*", 
       RowBox[{
       "delta\:4f1a\:53d8\:53f7", "\:ff0c", 
        "\:6240\:4ee5\:4e0d\:8981\:8bbe\:4e3a\:5168\:5c40\:53d8\:91cf", 
        "\:ff0c", "\:5426\:5219\:51fa\:9519"}], "*)"}], "\[IndentingNewLine]", 
      RowBox[{"poses", "=", 
       RowBox[{"{", 
        RowBox[{"{", 
         RowBox[{"xs", ",", "ys", ",", "\[Theta]s"}], "}"}], "}"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"Switch", "[", 
       RowBox[{
       "num", ",", "\[IndentingNewLine]", "1", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "2", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "3", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "4", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "5", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "6", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "7", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "8", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "9", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "10", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "11", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "12", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "13", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "14", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "15", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "16", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "17", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "18", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "19", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "20", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "21", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "22", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "23", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "24", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "25", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "26", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "27", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "28", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "29", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "30", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "31", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "32", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "33", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "34", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "35", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "36", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "37", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "38", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "39", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "40", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "41", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "42", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "43", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "44", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "45", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "46", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "fwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "fwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "47", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"left", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}], ",", 
        "\[IndentingNewLine]", "48", ",", "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "right", ",", "bwd", ",", "RSl1", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "1"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "straight", ",", "bwd", ",", "RSl2", ",", "x1", ",", "y1", ",", 
            "t1", ",", "delta", ",", "n"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{"right", ",", "bwd", ",", 
            RowBox[{"Pi", "/", "2"}], ",", "x1", ",", "y1", ",", "t1", ",", 
            "delta", ",", "n"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{
          RowBox[{"{", 
           RowBox[{"n", ",", "x1", ",", "y1", ",", "t1"}], "}"}], "=", 
          RowBox[{"fctcurve", "[", 
           RowBox[{
           "left", ",", "fwd", ",", "RSl3", ",", "x1", ",", "y1", ",", "t1", 
            ",", "delta", ",", "n"}], "]"}]}], ";"}]}], "\[IndentingNewLine]",
        "]"}]}]}], "\n", "]"}]}], ";"}]}], "Input",
 CellGroupingRules->{"GroupTogetherGrouping", 10000.},
 CellChangeTimes->{
  3.7904757583780146`*^9, {3.790475818954782*^9, 3.7904758425725803`*^9}, {
   3.7904759196333227`*^9, 3.790475921159986*^9}, {3.7904759555899425`*^9, 
   3.790475975523926*^9}, {3.790476128892006*^9, 3.7904761402853255`*^9}, {
   3.7904761945114574`*^9, 3.790476225083625*^9}, {3.7904762743674183`*^9, 
   3.790476300933222*^9}, 3.790476342219516*^9, {3.79047639178349*^9, 
   3.790476424012705*^9}, {3.790481184475465*^9, 3.790481241871348*^9}, {
   3.790481295519429*^9, 3.7904813101266356`*^9}, 3.7904813460350337`*^9, {
   3.7904813994016685`*^9, 3.790481416261978*^9}, {3.7904816319014072`*^9, 
   3.790481733839223*^9}, {3.7904863960826235`*^9, 3.790486482807407*^9}, {
   3.790486811635102*^9, 3.7904868121726646`*^9}, {3.7904871985502996`*^9, 
   3.7904872167730494`*^9}, {3.790487437089306*^9, 3.7904874598638587`*^9}, {
   3.7904887363190203`*^9, 3.7904887381980305`*^9}, {3.790488891737691*^9, 
   3.7904889292878113`*^9}, 3.7904895641623616`*^9, {3.7904900472404966`*^9, 
   3.7904900529702663`*^9}, {3.790490199020516*^9, 3.7904902045109468`*^9}, 
   3.7904902386117377`*^9, 3.7906589485520434`*^9, 3.791590462901*^9, {
   3.7915974659309998`*^9, 3.7915977506470003`*^9}, {3.791597788651*^9, 
   3.791597796499*^9}, {3.7915978812*^9, 3.791598017992*^9}, {
   3.791598130307*^9, 3.791598191005*^9}, {3.79159826858*^9, 
   3.791598269612*^9}, {3.7915986707939997`*^9, 3.791599169402*^9}, {
   3.7915992258789997`*^9, 3.791599457559*^9}, {3.791599576774*^9, 
   3.791599642308*^9}, {3.7915997442349997`*^9, 3.791599750133*^9}, {
   3.791599811738*^9, 3.791599863498*^9}, 3.791599928243*^9, {
   3.791599976693*^9, 3.791599999803*^9}, {3.791600032079*^9, 
   3.791600034267*^9}, {3.791600077881*^9, 3.791600086157*^9}, {
   3.791600244131*^9, 3.7916002459630003`*^9}, {3.791600499448*^9, 
   3.7916005333459997`*^9}, {3.7916007914960003`*^9, 
   3.7916008156689997`*^9}, {3.791600892432*^9, 3.7916009195480003`*^9}, {
   3.7916010300889997`*^9, 3.791601103986*^9}, {3.7916011405290003`*^9, 
   3.791601169858*^9}, {3.791601231597*^9, 3.7916016927869997`*^9}, 
   3.791602064354*^9, 3.791602108126*^9, {3.791602141041*^9, 
   3.79160217844*^9}, 3.7916035746470003`*^9, {3.791606520483*^9, 
   3.791606704112*^9}, {3.7916939962530003`*^9, 3.791694000968*^9}, 
   3.791697348043*^9, {3.7916980483*^9, 3.791698090329*^9}, {
   3.7917514049309998`*^9, 3.791751407248*^9}, {3.791751440459*^9, 
   3.7917516285699997`*^9}, {3.7917516874119997`*^9, 3.791751703238*^9}, {
   3.791752282432*^9, 3.7917527377209997`*^9}, {3.791769764132*^9, 
   3.791769879291*^9}, 3.791775958273*^9, {3.7917765574230003`*^9, 
   3.791776609816*^9}, {3.791776640979*^9, 3.791776656867*^9}, {
   3.791776704186*^9, 3.7917767746949997`*^9}, {3.791776862918*^9, 
   3.791776873575*^9}, {3.791860673752*^9, 3.791860680101*^9}, {
   3.792367610307*^9, 3.792367722668*^9}, 3.792968285302*^9, {
   3.7929683654985*^9, 3.7929687917685003`*^9}, {3.7929688256855*^9, 
   3.7929688531565*^9}, {3.7929689589154997`*^9, 3.7929689717235003`*^9}, {
   3.7929690195810003`*^9, 3.7929690336835003`*^9}, {3.792969940778*^9, 
   3.792969946807*^9}, {3.792969992848*^9, 3.7929699951685*^9}, {
   3.7929700357869997`*^9, 3.792970198091*^9}, {3.7929702541895*^9, 
   3.7929702557585*^9}, {3.792970346099*^9, 3.7929703482139997`*^9}, {
   3.792970385781*^9, 3.7929703912455*^9}, {3.7929888686625*^9, 
   3.79298887185*^9}, 3.792988922726*^9, {3.792989019691*^9, 
   3.7929890207385*^9}, {3.792989406144*^9, 3.792989512584*^9}, 
   3.7929895501844997`*^9, {3.7929898378050003`*^9, 3.7929898385915003`*^9}, 
   3.79972138648*^9, {3.799721872796*^9, 3.799721897855*^9}, {
   3.7997222549779997`*^9, 3.799722264281*^9}, {3.799722321809*^9, 
   3.7997223459700003`*^9}, {3.799722386947*^9, 3.799722461269*^9}, 
   3.799722524703*^9, {3.7997225667019997`*^9, 3.799722591109*^9}, {
   3.799722637119*^9, 3.799722666491*^9}, {3.799722816822*^9, 
   3.799722828262*^9}, {3.799722862913*^9, 3.799722863278*^9}, {
   3.799722916092*^9, 3.799722962949*^9}, {3.799722994962*^9, 
   3.799723001731*^9}, {3.799723099295*^9, 3.7997231193059998`*^9}, {
   3.79972327624*^9, 3.799723276435*^9}, {3.799723381278*^9, 
   3.799723384324*^9}, {3.799724100145*^9, 3.7997241324449997`*^9}, {
   3.7997241780039997`*^9, 3.799724286729*^9}, {3.799726534849*^9, 
   3.7997265350179996`*^9}, 3.799726939935*^9, {3.799727138948*^9, 
   3.7997273535699997`*^9}, {3.799727618078*^9, 3.799727618334*^9}, {
   3.7997966129041333`*^9, 3.7997966502216377`*^9}, {3.7997992336268125`*^9, 
   3.799799270019846*^9}, {3.7997993775001464`*^9, 3.799799389176883*^9}, 
   3.7997999607349243`*^9, {3.7999778009849997`*^9, 3.799977801278*^9}},
 CellLabel->
  "In[416]:=",ExpressionUUID->"1a645e91-d74d-43c2-9ae2-8fd8592d98e2"]
}, Closed]],

Cell[CellGroupData[{

Cell[TextData[StyleBox["\:5b9a\:4e49\:969c\:788d\:7269",
 FontWeight->"Bold",
 FontColor->RGBColor[1., 1., 1.]]], "Text",
 CellGroupingRules->{GroupTogetherGrouping, 10000.},
 CellChangeTimes->{
  3.6397942848343534`*^9, {3.6397943283110375`*^9, 3.6397943307450438`*^9}, {
   3.6397943837232227`*^9, 3.639794385839229*^9}, 3.6397944336894875`*^9, {
   3.639794855897752*^9, 3.639794885322799*^9}, {3.6397955409263296`*^9, 
   3.6397955626183686`*^9}, {3.639800404425104*^9, 3.6398004280832157`*^9}, 
   3.640907956913665*^9, {3.6409204558021493`*^9, 3.640920476494333*^9}, {
   3.640982614420762*^9, 3.640982614788783*^9}, {3.6412934381389723`*^9, 
   3.6412934480685406`*^9}, 3.646737203078804*^9, 3.799998595524809*^9},
 FontFamily->"Georgia",
 Background->GrayLevel[
  0],ExpressionUUID->"df1762ea-06ad-4365-b881-a6cf262212f1"],

Cell[BoxData[{
 RowBox[{
  RowBox[{"Clear", "@", "pts"}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"numObs", "=", "4"}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"pts", "[", "1", "]"}], "=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.32"}], ",", "0.68"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.6"}], ",", "0.6"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.68"}], ",", "0.36"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.52"}], ",", "0.24"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.24"}], ",", "0.4"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.24"}], ",", "0.6"}], "}"}]}], "}"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"pts", "[", "2", "]"}], "=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"0.1", ",", "0.58"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.18", ",", "0.4"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.34", ",", "0.48"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.52", ",", "0.3"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.4", ",", "0.1"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.46", ",", "0."}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.74", ",", "0.3"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.62", ",", "0.46"}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{"0.3", ",", "0.7"}], "}"}]}], "}"}]}], ";", 
  RowBox[{
   RowBox[{"pts", "[", "3", "]"}], "=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.6"}], ",", 
       RowBox[{"-", "0.2"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.72"}], ",", 
       RowBox[{"-", "0.36"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.68"}], ",", 
       RowBox[{"-", "0.52"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.4"}], ",", 
       RowBox[{"-", "0.68"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.12"}], ",", 
       RowBox[{"-", "0.48"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.32"}], ",", 
       RowBox[{"-", "0.4"}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"-", "0.44"}], ",", 
       RowBox[{"-", "0.2"}]}], "}"}]}], "}"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{
    RowBox[{"pts", "[", "4", "]"}], "=", 
    RowBox[{"{", 
     RowBox[{
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.2"}], ",", 
        RowBox[{"-", "0.1"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "0.2"}], ",", "0.1"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.72", ",", 
        RowBox[{"-", "0.3"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.8", ",", 
        RowBox[{"-", "0.4"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.4", ",", 
        RowBox[{"-", "0.4"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.4", ",", 
        RowBox[{"-", "0.6"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.3", ",", 
        RowBox[{"-", "0.6"}]}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"0.2", ",", 
        RowBox[{"-", "0.3"}]}], "}"}]}], "}"}]}], ";"}], 
  "\[IndentingNewLine]", 
  RowBox[{"(*", 
   RowBox[{
    RowBox[{
     RowBox[{"pts", "[", "1", "]"}], "=", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{
         RowBox[{"-", "1"}], ",", "0"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"0.5", ",", "0"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"0.5", ",", 
         RowBox[{"-", "0.21"}]}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"0.61", ",", 
         RowBox[{"-", "0.21"}]}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"0.61", ",", "0"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"1", ",", "0"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"1", ",", 
         RowBox[{"-", "1"}]}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{
         RowBox[{"-", "1"}], ",", 
         RowBox[{"-", "1"}]}], "}"}]}], "}"}]}], ";", "\[IndentingNewLine]", 
    RowBox[{
     RowBox[{"pts", "[", "2", "]"}], "=", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{
         RowBox[{"-", "1"}], ",", "0.32"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"1", ",", "0.32"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"1", ",", "1"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{
         RowBox[{"-", "1"}], ",", "1"}], "}"}]}], "}"}]}], ";"}], 
   "*)"}]}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"Do", "[", 
   RowBox[{
    RowBox[{
     RowBox[{"obstacle", "[", "i", "]"}], "=", 
     RowBox[{"Polygon", "[", 
      RowBox[{"pts", "[", "i", "]"}], "]"}]}], ",", 
    RowBox[{"{", 
     RowBox[{"i", ",", "numObs"}], "}"}]}], "]"}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"obstaclesRegion", "=", 
   RowBox[{"Table", "[", 
    RowBox[{
     RowBox[{"obstacle", "[", "i", "]"}], ",", 
     RowBox[{"{", 
      RowBox[{"i", ",", "numObs"}], "}"}]}], "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"obstaclesRegionAll", "=", 
   RowBox[{"RegionUnion", "[", "obstaclesRegion", "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{"Graphics", "[", 
  RowBox[{
   RowBox[{"{", 
    RowBox[{"(*", 
     RowBox[{"Green", ",", 
      RowBox[{"Polygon", "[", 
       RowBox[{"carCorner", "[", "startPose", "]"}], "]"}], ",", 
      RowBox[{"Polygon", "[", 
       RowBox[{"carCorner", "[", "goalPose", "]"}], "]"}], ","}], "*)"}], 
    RowBox[{"Black", ",", "obstaclesRegion"}], "}"}], ",", 
   RowBox[{"PlotRange", "\[Rule]", "1"}], ",", 
   RowBox[{"Axes", "\[Rule]", "True"}]}], "]"}]}], "Input",
 CellChangeTimes->{{3.6414383793574085`*^9, 3.641438406333952*^9}, {
   3.6467289328387737`*^9, 3.6467289377910566`*^9}, {3.798929506726*^9, 
   3.798929517525*^9}, {3.798929591565*^9, 3.798929600032*^9}, {
   3.799102502946*^9, 3.799102505916*^9}, {3.79911781299*^9, 
   3.799117815426*^9}, {3.799121208697*^9, 3.79912125773*^9}, {
   3.799121297258*^9, 3.799121298149*^9}, {3.799443407428*^9, 
   3.799443513856*^9}, 3.799450035058*^9, {3.799460725683*^9, 
   3.799460960117*^9}, 3.799463329141*^9, 3.799466030984*^9, {
   3.799467853642*^9, 3.799467854921*^9}, {3.799468165924*^9, 
   3.799468166493*^9}, {3.799468208729*^9, 3.799468214799*^9}, 
   3.7994684497530003`*^9, {3.799468495492*^9, 3.799468500505*^9}, {
   3.799468530642*^9, 3.7994687034*^9}, {3.799632839525*^9, 
   3.799632864815*^9}, 3.7996331221870003`*^9, {3.799633518763*^9, 
   3.799633546451*^9}, {3.799633754887*^9, 3.799633762742*^9}, {
   3.799634726124*^9, 3.799634729477*^9}, 3.799962547618*^9, {
   3.79996258527*^9, 3.799962621715*^9}, 3.799990015803*^9, {3.79999005391*^9,
    3.799990237693*^9}, {3.7999903096210003`*^9, 3.799990331179*^9}, {
   3.799990386092*^9, 3.799990407185*^9}, {3.799990477079*^9, 
   3.799990533587*^9}, {3.799990574741*^9, 3.7999905767320004`*^9}, {
   3.799990750697*^9, 3.799990752332*^9}, {3.799990850672*^9, 
   3.799990851566*^9}, {3.7999913904890003`*^9, 3.799991391249*^9}, {
   3.799991663953*^9, 3.7999916660439997`*^9}, {3.79999170459*^9, 
   3.799991737973*^9}, {3.799998610329339*^9, 
   3.79999861969886*^9}},ExpressionUUID->"2a5c3f71-ad30-4350-838b-\
96353f7ba81f"],

Cell[BoxData[{
 RowBox[{
  RowBox[{
   RowBox[{"ptCollisionCheck", "=", 
    RowBox[{"RegionMember", "[", "obstaclesRegionAll", "]"}]}], ";"}], 
  RowBox[{
  "(*", "True\:8868\:793a\:78b0\:649e", "*)"}]}], "\[IndentingNewLine]", 
 RowBox[{"AbsoluteTiming", "[", 
  RowBox[{
   RowBox[{"ptCollisionCheck", "/@", 
    RowBox[{"RandomReal", "[", 
     RowBox[{
      RowBox[{"{", 
       RowBox[{
        RowBox[{"-", "1"}], ",", "1"}], "}"}], ",", 
      RowBox[{"{", 
       RowBox[{"100000", ",", "2"}], "}"}]}], "]"}]}], ";"}], "]"}]}], "Input",
 CellChangeTimes->{{3.799468721667*^9, 3.7994687357320004`*^9}, {
   3.799468838778*^9, 3.7994688709560003`*^9}, {3.799468903991*^9, 
   3.7994689073719997`*^9}, {3.799470067775*^9, 3.7994701024639997`*^9}, 
   3.799471559216*^9, 3.799632554743*^9, {3.799632601807*^9, 
   3.799632602933*^9}, {3.799632649748*^9, 3.799632654851*^9}, {
   3.799632696601*^9, 3.799632740207*^9}, {3.799632798223*^9, 
   3.799632896324*^9}, {3.799632980553*^9, 3.799632994102*^9}, {
   3.799633194008*^9, 3.799633195058*^9}, {3.799633750828*^9, 
   3.7996337513599997`*^9}},
 CellLabel->
  "In[409]:=",ExpressionUUID->"4973a056-0bb7-4dec-b287-338ea256b275"],

Cell[BoxData[{
 RowBox[{
  RowBox[{
   RowBox[{
    RowBox[{"{", 
     RowBox[{"carL", ",", "carW"}], "}"}], "=", 
    RowBox[{"{", 
     RowBox[{"0.1", ",", "0.05"}], "}"}]}], ";"}], 
  RowBox[{
  "(*", "\:8f66\:4e00\:534a\:7684\:5c3a\:5bf8", 
   "*)"}]}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"carCorner", "[", 
    RowBox[{"{", 
     RowBox[{"x_", ",", "y_", ",", "\[Theta]_"}], "}"}], "]"}], ":=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{
       RowBox[{"x", "+", 
        RowBox[{"carL", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}]}], "-", 
        RowBox[{"carW", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}]}]}], ",", 
       RowBox[{"y", "+", 
        RowBox[{"carW", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}]}], "+", 
        RowBox[{"carL", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}]}]}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"x", "-", 
        RowBox[{"carL", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}]}], "-", 
        RowBox[{"carW", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}]}]}], ",", 
       RowBox[{"y", "+", 
        RowBox[{"carW", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}]}], "-", 
        RowBox[{"carL", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}]}]}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"x", "-", 
        RowBox[{"carL", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}]}], "+", 
        RowBox[{"carW", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}]}]}], ",", 
       RowBox[{"y", "-", 
        RowBox[{"carW", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}]}], "-", 
        RowBox[{"carL", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}]}]}]}], "}"}], ",", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"x", "+", 
        RowBox[{"carL", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}]}], "+", 
        RowBox[{"carW", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}]}]}], ",", 
       RowBox[{"y", "-", 
        RowBox[{"carW", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}]}], "+", 
        RowBox[{"carL", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}]}]}]}], "}"}]}], "}"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"poseCollisionCheck", "[", "pose_", "]"}], ":=", 
   RowBox[{"!", 
    RowBox[{"RegionDisjoint", "[", 
     RowBox[{
      RowBox[{"Polygon", "[", 
       RowBox[{"carCorner", "[", "pose", "]"}], "]"}], ",", 
      "obstaclesRegionAll"}], "]"}]}]}], ";", "  ", 
  RowBox[{"(*", "True\:8868\:793a\:78b0\:649e", "*)"}], "\[IndentingNewLine]", 
  RowBox[{"AbsoluteTiming", "[", 
   RowBox[{
    RowBox[{"poseCollisionCheck", "/@", 
     RowBox[{"RandomReal", "[", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{
         RowBox[{"-", "1"}], ",", "1"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{"100", ",", "3"}], "}"}]}], "]"}]}], ";"}], "]"}]}]}], "Input",
 CellChangeTimes->{{3.799632237275*^9, 3.7996322415290003`*^9}, {
   3.799632318369*^9, 3.799632393656*^9}, {3.799632423796*^9, 
   3.799632518403*^9}, {3.799633023639*^9, 3.799633198236*^9}, {
   3.799633240547*^9, 3.7996332514969997`*^9}, {3.799633324024*^9, 
   3.7996333242279997`*^9}, {3.799633364082*^9, 3.7996334883129997`*^9}, {
   3.799633530219*^9, 3.799633736917*^9}, {3.7996337750629997`*^9, 
   3.799633786278*^9}, {3.799634734141*^9, 3.799634820435*^9}, 
   3.7996356029960003`*^9, {3.7999986380996947`*^9, 
   3.799998638983156*^9}},ExpressionUUID->"4ed375e7-40fa-4a7f-841a-\
c2fb517a2870"]
}, Closed]],

Cell[CellGroupData[{

Cell[TextData[StyleBox["\:6df7\:5408A\:661f\:51fd\:6570",
 FontWeight->"Bold",
 FontColor->RGBColor[1., 1., 1.]]], "Text",
 CellGroupingRules->{GroupTogetherGrouping, 10000.},
 CellChangeTimes->{
  3.6397942848343534`*^9, {3.6397943283110375`*^9, 3.6397943307450438`*^9}, {
   3.6397943837232227`*^9, 3.639794385839229*^9}, 3.6397944336894875`*^9, {
   3.639794855897752*^9, 3.639794885322799*^9}, {3.6397955409263296`*^9, 
   3.6397955626183686`*^9}, {3.639800404425104*^9, 3.6398004280832157`*^9}, 
   3.640907956913665*^9, {3.6409204558021493`*^9, 3.640920476494333*^9}, {
   3.640982614420762*^9, 3.640982614788783*^9}, {3.6412934381389723`*^9, 
   3.6412934480685406`*^9}, 3.7999828880109997`*^9},
 FontFamily->"Georgia",
 Background->GrayLevel[
  0],ExpressionUUID->"b6695ca9-8cfc-4e5c-8e0c-f575e2dc8557"],

Cell[BoxData[{
 RowBox[{
  RowBox[{
   RowBox[{"modTo02Pi", "[", "angle_", "]"}], ":=", " ", 
   RowBox[{"Mod", "[", 
    RowBox[{"angle", ",", 
     RowBox[{"2.0", "*", "Pi"}]}], "]"}]}], ";"}], "\n", 
 RowBox[{
  RowBox[{
   RowBox[{"modToPiPi", "[", "angle_", "]"}], ":=", " ", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"a", " ", "=", " ", 
       RowBox[{"modTo02Pi", "[", "angle", "]"}]}], "}"}], ",", 
     RowBox[{
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{
         RowBox[{"Re", "[", "a", "]"}], "<", 
         RowBox[{"-", "Pi"}]}], ",", 
        RowBox[{"a", "=", 
         RowBox[{"a", "+", 
          RowBox[{"2.0", "*", "Pi"}]}]}]}], "]"}], ";", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{
         RowBox[{"Re", "[", "a", "]"}], "\[GreaterEqual]", "Pi"}], ",", 
        RowBox[{"a", "=", 
         RowBox[{"a", "-", 
          RowBox[{"2.0", "*", "Pi"}]}]}]}], "]"}], ";", "a"}]}], "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"dt", "=", "0.02"}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"L", "=", "0.2"}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"{", 
    RowBox[{"v`max", ",", "\[Phi]`max"}], "}"}], "=", 
   RowBox[{"{", 
    RowBox[{"1.0", ",", 
     RowBox[{"\[Pi]", "/", "4.0"}]}], "}"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"Rmin", "=", 
   RowBox[{"L", "/", 
    RowBox[{"Tan", "[", "\[Phi]`max", "]"}]}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"bicycle", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"x0_", ",", " ", "y0_", ",", " ", "\[Theta]0_"}], "}"}], ",", 
     RowBox[{"{", " ", 
      RowBox[{"v_", ",", " ", "\[Phi]_"}], "}"}]}], "]"}], " ", ":=", " ", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"x", ",", "y", ",", "\[Theta]"}], "}"}], ",", 
     "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"\[Theta]", "=", 
       RowBox[{"modToPiPi", "[", 
        RowBox[{"\[Theta]0", "+", 
         RowBox[{"v", " ", 
          RowBox[{
           RowBox[{"Tan", "[", "\[Phi]", "]"}], "/", "L"}], "*", "dt"}]}], 
        "]"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"x", " ", "=", 
       RowBox[{"x0", "+", 
        RowBox[{"v", " ", 
         RowBox[{"Cos", "[", "\[Theta]", "]"}], "*", "dt"}]}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"y", " ", "=", 
       RowBox[{"y0", "+", 
        RowBox[{"v", " ", 
         RowBox[{"Sin", "[", "\[Theta]", "]"}], "*", "dt"}]}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"{", 
       RowBox[{"x", ",", " ", "y", ",", " ", "\[Theta]"}], "}"}]}]}], "]"}]}],
   ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"CalcIdx", "[", "pose_", "]"}], ":=", 
  RowBox[{"Floor", "[", 
   RowBox[{"pose", "/", 
    RowBox[{"{", 
     RowBox[{"dx", ",", "dy", ",", "d\[Theta]"}], "}"}]}], 
   "]"}]}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"findMinCost", "[", "open_", "]"}], ":=", 
  RowBox[{"Module", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
      RowBox[{"mincost", "=", "Infinity"}], ",", 
      RowBox[{"minnode", "=", 
       RowBox[{"{", "}"}]}], ",", "cost"}], "}"}], ",", 
    RowBox[{
     RowBox[{"Do", "[", 
      RowBox[{
       RowBox[{
        RowBox[{"cost", "=", 
         RowBox[{"node", "\[LeftDoubleBracket]", 
          RowBox[{"3", ",", "1"}], "\[RightDoubleBracket]"}]}], ";", 
        RowBox[{"If", "[", 
         RowBox[{
          RowBox[{"cost", "\[LessEqual]", "mincost"}], ",", 
          RowBox[{
           RowBox[{"mincost", "=", "cost"}], ";", " ", 
           RowBox[{"minnode", "=", "node"}]}]}], "]"}]}], ",", 
       RowBox[{"{", 
        RowBox[{"node", ",", "open"}], "}"}]}], "]"}], ";", "minnode"}]}], 
   "]"}]}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"backTrack", "[", "]"}], ":=", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"node", ",", "father", ",", "fathers", ",", "path"}], "}"}], 
     ",", "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"node", "=", 
       RowBox[{"Last", "[", "closed", "]"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"path", "=", 
       RowBox[{"{", 
        RowBox[{"Length", "[", "closed", "]"}], "}"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"Do", "[", 
       RowBox[{
        RowBox[{
         RowBox[{"father", "=", 
          RowBox[{"Last", "[", "node", "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"If", "[", 
          RowBox[{
           RowBox[{"father", "\[GreaterEqual]", "1"}], ",", 
           RowBox[{
            RowBox[{"node", "=", 
             RowBox[{
             "closed", "\[LeftDoubleBracket]", "father", 
              "\[RightDoubleBracket]"}]}], ";", "\[IndentingNewLine]", 
            RowBox[{"AppendTo", "[", 
             RowBox[{"path", ",", "father"}], "]"}], ";", 
            "\[IndentingNewLine]", 
            RowBox[{"If", "[", 
             RowBox[{
              RowBox[{"father", "\[Equal]", "0"}], ",", 
              RowBox[{"Break", "[", "]"}]}], "]"}], ";"}]}], 
          "\[IndentingNewLine]", "]"}], ";"}], "\[IndentingNewLine]", ",", 
        RowBox[{"{", 
         RowBox[{"Length", "[", "closed", "]"}], "}"}]}], "]"}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"fathers", "=", 
       RowBox[{"Reverse", "[", "path", "]"}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"Flatten", "[", 
       RowBox[{
        RowBox[{"closed", "\[LeftDoubleBracket]", 
         RowBox[{"fathers", ",", 
          RowBox[{"-", "2"}]}], "\[RightDoubleBracket]"}], ",", "1"}], 
       "]"}]}]}], "\[IndentingNewLine]", "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"extend", "[", "i_", "]"}], ":=", 
   RowBox[{"Module", "[", 
    RowBox[{
     RowBox[{"{", 
      RowBox[{"Qs", ",", "cost", ",", "steps"}], "}"}], ",", 
     "\[IndentingNewLine]", 
     RowBox[{
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{"open", "\[Equal]", 
         RowBox[{"{", "}"}]}], ",", 
        RowBox[{"Return", "[", "]"}]}], "]"}], ";", "\[IndentingNewLine]", 
      RowBox[{"currentNode", "=", 
       RowBox[{"findMinCost", "[", "open", "]"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"currentNodeIndex", ",", "currentPose", ",", 
         RowBox[{"{", 
          RowBox[{"ft", ",", "gt", ",", "ht"}], "}"}], ",", "Qtm", ",", 
         "index"}], "}"}], "=", "currentNode"}], ";", "\[IndentingNewLine]", 
      RowBox[{"open", "=", 
       RowBox[{"Complement", "[", 
        RowBox[{"open", ",", 
         RowBox[{"{", "currentNode", "}"}]}], "]"}]}], ";", 
      "\[IndentingNewLine]", 
      RowBox[{"closed", "=", 
       RowBox[{"closed", "~", "Join", "~", 
        RowBox[{"{", "currentNode", "}"}]}]}], ";", "\[IndentingNewLine]", 
      RowBox[{"father", "++"}], ";", "\[IndentingNewLine]", 
      RowBox[{"If", "[", 
       RowBox[{
        RowBox[{"i", ">", "50"}], ",", 
        RowBox[{"(*", "\:53ef\:8c03\:53c2\:6570", "*)"}], 
        "\[IndentingNewLine]", 
        RowBox[{
         RowBox[{"ReedShepp", "[", 
          RowBox[{"currentPose", ",", "goalPose"}], "]"}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{"constRS", "[", 
          RowBox[{"num", ",", 
           RowBox[{"{", 
            RowBox[{"RSl1", ",", "RSl2", ",", "RSl3"}], "}"}], ",", 
           "currentPose", ",", 
           RowBox[{"0.2", "dt"}]}], "]"}], ";", "\[IndentingNewLine]", 
         RowBox[{"condition", "=", 
          RowBox[{"!", 
           RowBox[{"Apply", "[", 
            RowBox[{"Or", ",", 
             RowBox[{"poseCollisionCheck", "/@", "poses"}]}], "]"}]}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{"If", "[", 
          RowBox[{"condition", ",", "\[IndentingNewLine]", 
           RowBox[{
            RowBox[{"endpose", "=", 
             RowBox[{"Last", "[", "poses", "]"}]}], ";", 
            "\[IndentingNewLine]", 
            RowBox[{"newnode", "=", 
             RowBox[{"{", 
              RowBox[{
               RowBox[{"CalcIdx", "[", "endpose", "]"}], ",", "endpose", ",", 
               RowBox[{"{", 
                RowBox[{"0", ",", "0", ",", "0"}], "}"}], ",", "poses", ",", 
               "father"}], "}"}]}], ";", "\[IndentingNewLine]", 
            RowBox[{"closed", "=", 
             RowBox[{"closed", "~", "Join", "~", 
              RowBox[{"{", "newnode", "}"}]}]}], ";", "\[IndentingNewLine]", 
            RowBox[{"Print", "[", "\"\<Goal Reached!\>\"", "]"}], ";", 
            "\[IndentingNewLine]", 
            RowBox[{"Break", "[", "]"}]}]}], "]"}], ";"}]}], 
       "\[IndentingNewLine]", "]"}], ";", "\[IndentingNewLine]", 
      RowBox[{"controlSamples", "=", 
       RowBox[{"{", 
        RowBox[{
         RowBox[{"{", 
          RowBox[{"v`max", ",", "0"}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{
           RowBox[{"-", "v`max"}], ",", "0"}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{"v`max", ",", "\[Phi]`max"}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{
           RowBox[{"-", "v`max"}], ",", "\[Phi]`max"}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{"v`max", ",", 
           RowBox[{"-", "\[Phi]`max"}]}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{
           RowBox[{"-", "v`max"}], ",", 
           RowBox[{"-", "\[Phi]`max"}]}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{"v`max", ",", 
           RowBox[{"\[Phi]`max", "/", "3"}]}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{"v`max", ",", 
           RowBox[{
            RowBox[{"-", "\[Phi]`max"}], "/", "3"}]}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{
           RowBox[{"-", "v`max"}], ",", 
           RowBox[{"\[Phi]`max", "/", "3"}]}], "}"}], ",", 
         RowBox[{"{", 
          RowBox[{
           RowBox[{"-", "v`max"}], ",", 
           RowBox[{
            RowBox[{"-", "\[Phi]`max"}], "/", "3"}]}], "}"}]}], "}"}]}], ";", 
      RowBox[{"(*", "\:53ef\:8c03\:53c2\:6570", "*)"}], "\[IndentingNewLine]", 
      RowBox[{"Do", "[", "\[IndentingNewLine]", 
       RowBox[{
        RowBox[{
         RowBox[{"pose", "=", "currentPose"}], ";", "\[IndentingNewLine]", 
         RowBox[{"steps", "=", "5"}], ";", 
         RowBox[{"(*", "\:53ef\:8c03\:53c2\:6570", "*)"}], 
         "\[IndentingNewLine]", 
         RowBox[{"Qs", "=", 
          RowBox[{
           RowBox[{"{", "pose", "}"}], "~", "Join", "~", 
           RowBox[{"Table", "[", 
            RowBox[{
             RowBox[{"pose", "=", 
              RowBox[{"bicycle", "[", 
               RowBox[{"pose", ",", "u"}], "]"}]}], ",", 
             RowBox[{"{", 
              RowBox[{"k", ",", "steps"}], "}"}]}], "]"}]}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{"endpose", "=", 
          RowBox[{"Last", "[", "Qs", "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"nodeIndex", "=", 
          RowBox[{"CalcIdx", "[", "endpose", "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{"edgecost", "=", 
          RowBox[{"steps", "*", "dt"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"g", "=", 
          RowBox[{"gt", "+", "edgecost"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"h", "=", 
          RowBox[{"ReedShepp", "[", 
           RowBox[{"endpose", ",", "goalPose"}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{"w", "=", "0.6"}], ";", 
         RowBox[{"(*", "\:53ef\:8c03\:53c2\:6570", "*)"}], 
         "\[IndentingNewLine]", 
         RowBox[{"f", "=", 
          RowBox[{
           RowBox[{
            RowBox[{"(", 
             RowBox[{"1", "-", "w"}], ")"}], "*", "g"}], "+", 
           RowBox[{"w", "*", "h"}]}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"node", "=", 
          RowBox[{"{", 
           RowBox[{"nodeIndex", ",", "endpose", ",", 
            RowBox[{"{", 
             RowBox[{"f", ",", "g", ",", "h"}], "}"}], ",", "Qs", ",", 
            "father"}], "}"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"condition1", "=", 
          RowBox[{"MemberQ", "[", 
           RowBox[{
            RowBox[{"closed", "\[LeftDoubleBracket]", 
             RowBox[{";;", ",", "1"}], "\[RightDoubleBracket]"}], ",", 
            "nodeIndex"}], "]"}]}], ";", "\[IndentingNewLine]", 
         RowBox[{"condition2", "=", 
          RowBox[{"Apply", "[", 
           RowBox[{"Or", ",", 
            RowBox[{"poseCollisionCheck", "/@", "Qs"}]}], "]"}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{"condition3", "=", 
          RowBox[{
           RowBox[{
            RowBox[{
            "nodeIndex", "\[LeftDoubleBracket]", "1", 
             "\[RightDoubleBracket]"}], ">", 
            RowBox[{"1", "/", "dx"}]}], "||", 
           RowBox[{
            RowBox[{
            "nodeIndex", "\[LeftDoubleBracket]", "1", 
             "\[RightDoubleBracket]"}], "<", 
            RowBox[{
             RowBox[{"-", "1"}], "/", "dx"}]}], "||", 
           RowBox[{
            RowBox[{
            "nodeIndex", "\[LeftDoubleBracket]", "2", 
             "\[RightDoubleBracket]"}], ">", 
            RowBox[{"1", "/", "dy"}]}], "||", 
           RowBox[{
            RowBox[{
            "nodeIndex", "\[LeftDoubleBracket]", "2", 
             "\[RightDoubleBracket]"}], "<", 
            RowBox[{
             RowBox[{"-", "1"}], "/", "dy"}]}], "||", 
           RowBox[{
            RowBox[{
            "nodeIndex", "\[LeftDoubleBracket]", "3", 
             "\[RightDoubleBracket]"}], "<", 
            RowBox[{
             RowBox[{"-", "Pi"}], "/", "d\[Theta]"}]}], "||", 
           RowBox[{
            RowBox[{
            "nodeIndex", "\[LeftDoubleBracket]", "3", 
             "\[RightDoubleBracket]"}], ">", 
            RowBox[{"Pi", "/", "d\[Theta]"}]}]}]}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{"If", "[", 
          RowBox[{
           RowBox[{"condition1", "||", "condition2", "||", "condition3"}], 
           ",", 
           RowBox[{"Continue", "[", "]"}]}], "]"}], ";", 
         "\[IndentingNewLine]", 
         RowBox[{"If", "[", 
          RowBox[{
           RowBox[{"MemberQ", "[", 
            RowBox[{
             RowBox[{"open", "\[LeftDoubleBracket]", 
              RowBox[{";;", ",", "1"}], "\[RightDoubleBracket]"}], ",", 
             "nodeIndex"}], "]"}], ",", "\[IndentingNewLine]", 
           RowBox[{
            RowBox[{
             RowBox[{"{", 
              RowBox[{"{", "p", "}"}], "}"}], "=", 
             RowBox[{"Position", "[", 
              RowBox[{
               RowBox[{"open", "\[LeftDoubleBracket]", 
                RowBox[{";;", ",", "1"}], "\[RightDoubleBracket]"}], ",", 
               "nodeIndex"}], "]"}]}], ";", "\[IndentingNewLine]", 
            RowBox[{"If", "[", 
             RowBox[{
              RowBox[{
               RowBox[{"open", "\[LeftDoubleBracket]", 
                RowBox[{"p", ",", "3", ",", "1"}], "\[RightDoubleBracket]"}], 
               "<", "f"}], ",", 
              RowBox[{"Continue", "[", "]"}], ",", 
              RowBox[{
               RowBox[{
               "open", "\[LeftDoubleBracket]", "p", "\[RightDoubleBracket]"}],
                "=", "node"}]}], "]"}], ";"}], "\[IndentingNewLine]", ",", 
           "\[IndentingNewLine]", 
           RowBox[{"open", "=", 
            RowBox[{"open", "~", "Join", "~", 
             RowBox[{"{", "node", "}"}]}]}]}], "\[IndentingNewLine]", "]"}], 
         ";"}], "\[IndentingNewLine]", ",", 
        RowBox[{"{", 
         RowBox[{"u", ",", "controlSamples"}], "}"}]}], "]"}], ";"}]}], 
    "\[IndentingNewLine]", "]"}]}], ";"}]}], "Input",
 CellChangeTimes->{{3.640944712019026*^9, 3.6409447125220547`*^9}, {
   3.6409448842078743`*^9, 3.6409448846659007`*^9}, {3.6409450233068304`*^9, 
   3.640945060444955*^9}, {3.6409452432774124`*^9, 3.640945290432109*^9}, {
   3.640945532632962*^9, 3.6409456404031267`*^9}, {3.640945767693407*^9, 
   3.6409457686254606`*^9}, {3.6409458067616415`*^9, 
   3.6409458673061047`*^9}, {3.6409824896276245`*^9, 
   3.6409825980258245`*^9}, {3.6409826617854714`*^9, 3.64098283326528*^9}, {
   3.640982924061473*^9, 3.6409829562933164`*^9}, {3.640982990256259*^9, 
   3.6409830084893017`*^9}, {3.6409836867230945`*^9, 
   3.6409837034530516`*^9}, {3.6409839695992737`*^9, 3.640983980492897*^9}, {
   3.640984026150509*^9, 3.640984044060533*^9}, 3.6409917146322646`*^9, {
   3.6409918400524383`*^9, 3.6409918432826233`*^9}, {3.6412030946176453`*^9, 
   3.641203163132966*^9}, {3.6412034937327757`*^9, 3.6412037122111597`*^9}, {
   3.6412050123173084`*^9, 3.641205012566909*^9}, {3.6412050732354155`*^9, 
   3.641205075466219*^9}, {3.641205106588274*^9, 3.641205123639104*^9}, {
   3.6412051713907876`*^9, 3.6412051922792244`*^9}, {3.6412052313728933`*^9, 
   3.6412052742729683`*^9}, {3.641205885476793*^9, 3.641205915332852*^9}, 
   3.6412853294781837`*^9, {3.641285415822122*^9, 3.641285418196258*^9}, 
   3.6412854490450225`*^9, {3.6412854977698092`*^9, 3.641285501766038*^9}, {
   3.641285540320243*^9, 3.6412855711910086`*^9}, 3.6412857890194674`*^9, {
   3.6412864791809425`*^9, 3.641286480729031*^9}, 3.6412865168400965`*^9, {
   3.64128681533917*^9, 3.6412868179243174`*^9}, 3.641287307048294*^9, 
   3.641287602111171*^9, {3.641289627427012*^9, 3.641289628122052*^9}, {
   3.64129297636056*^9, 3.6412930068523045`*^9}, {3.6412930892770185`*^9, 
   3.641293117651642*^9}, {3.6412932078348*^9, 3.641293230634104*^9}, 
   3.641363566540063*^9, 3.6413636191040688`*^9, {3.641365848771599*^9, 
   3.641365850754712*^9}, {3.6414373157045712`*^9, 3.6414373602511187`*^9}, {
   3.6414374301921196`*^9, 3.6414374619799376`*^9}, 3.641437676598213*^9, {
   3.6414380403970213`*^9, 3.6414380650694323`*^9}, {3.641438201022208*^9, 
   3.6414382127738805`*^9}, 3.641438273206337*^9, {3.6414383150997334`*^9, 
   3.641438345585477*^9}, {3.6414384944939938`*^9, 3.641438500033311*^9}, 
   3.64143870702615*^9, {3.6414387610502405`*^9, 3.6414387888538303`*^9}, {
   3.641438888575534*^9, 3.6414389055035024`*^9}, {3.6414390497847548`*^9, 
   3.641439119645751*^9}, {3.6414391505945206`*^9, 3.641439150661525*^9}, {
   3.6414391948380513`*^9, 3.641439197523205*^9}, {3.641439334241025*^9, 
   3.6414393614065785`*^9}, 3.6414395028656693`*^9, {3.641439579393047*^9, 
   3.641439673481428*^9}, {3.64143972946463*^9, 3.6414397514118853`*^9}, {
   3.6414403279238605`*^9, 3.641440434989984*^9}, 3.6414404707780313`*^9, {
   3.6414405131684556`*^9, 3.641440603316612*^9}, 3.6414406689483657`*^9, {
   3.641440732328991*^9, 3.6414407753874536`*^9}, {3.6414408166238127`*^9, 
   3.641440844649415*^9}, {3.6414408776103*^9, 3.6414408886569324`*^9}, {
   3.641440920222738*^9, 3.641441012988044*^9}, {3.641441052564307*^9, 
   3.6414410532753477`*^9}, 3.64144110016803*^9, 3.641441160376474*^9, {
   3.646729008428097*^9, 3.646729013492387*^9}, {3.6467291708623877`*^9, 
   3.646729173073514*^9}, {3.646729214684894*^9, 3.646729243382536*^9}, {
   3.646729810294961*^9, 3.6467298679702597`*^9}, {3.646729900538123*^9, 
   3.646729940862429*^9}, 3.6467303832687335`*^9, {3.6467304202338476`*^9, 
   3.64673042236397*^9}, 3.646730474280939*^9, {3.6467305106880217`*^9, 
   3.6467305594938126`*^9}, {3.6467307456714616`*^9, 
   3.6467307782723265`*^9}, {3.646730858109893*^9, 3.646730899115238*^9}, {
   3.6467314761102405`*^9, 3.64673164096867*^9}, {3.646731712569765*^9, 
   3.646731735157057*^9}, {3.6467318274483356`*^9, 3.6467318359418216`*^9}, {
   3.646731871489855*^9, 3.6467318730179424`*^9}, {3.646732129902635*^9, 
   3.646732148356691*^9}, {3.646732225483102*^9, 3.6467322367857485`*^9}, {
   3.6467322791501713`*^9, 3.6467322986302857`*^9}, {3.6467324497639303`*^9, 
   3.646732459592492*^9}, {3.6467325592121906`*^9, 3.6467325726219573`*^9}, {
   3.646732638253711*^9, 3.6467327228735514`*^9}, {3.646732762632825*^9, 
   3.6467327820929384`*^9}, {3.6467329000066824`*^9, 3.646732915155549*^9}, {
   3.6467329799612556`*^9, 3.6467329802752733`*^9}, {3.6467331794956684`*^9, 
   3.6467332130545883`*^9}, {3.646733258457185*^9, 3.6467332598972673`*^9}, 
   3.646733293219173*^9, {3.6467333294362445`*^9, 3.646733356139772*^9}, {
   3.6467340365126867`*^9, 3.646734041972999*^9}, {3.6467341224526024`*^9, 
   3.646734171870429*^9}, {3.6467342064224052`*^9, 3.6467342154269204`*^9}, {
   3.6467342467787137`*^9, 3.646734251836003*^9}, {3.646734305687083*^9, 
   3.6467343332326584`*^9}, 3.6467343775041904`*^9, {3.646734411103112*^9, 
   3.6467344145693107`*^9}, {3.646734467268325*^9, 3.6467344808591022`*^9}, {
   3.6467347832954006`*^9, 3.6467348920046186`*^9}, {3.646734933761007*^9, 
   3.646734938342269*^9}, {3.6467350522627845`*^9, 3.646735095831277*^9}, {
   3.6467352885853014`*^9, 3.646735313575731*^9}, 3.646735560670864*^9, {
   3.6467356024082513`*^9, 3.646735614751957*^9}, {3.6467356608485937`*^9, 
   3.646735679888683*^9}, {3.6467357903329997`*^9, 3.6467357978264284`*^9}, 
   3.646736063287612*^9, {3.64673614909752*^9, 3.646736149169524*^9}, 
   3.646736182910454*^9, {3.64673622602792*^9, 3.646736230890198*^9}, {
   3.6467364395371323`*^9, 3.6467364617834044`*^9}, {3.646736567089428*^9, 
   3.6467365963251*^9}, 3.6467366827420425`*^9, {3.6467369624070387`*^9, 
   3.646736963706113*^9}, 3.6467370986818333`*^9, {3.6467371315217113`*^9, 
   3.646737150751811*^9}, {3.646737736130293*^9, 3.6467377894323416`*^9}, {
   3.6467757035228357`*^9, 3.6467757867355957`*^9}, {3.6467760293654733`*^9, 
   3.6467761485762916`*^9}, 3.6467762152771063`*^9, {3.6467762502611074`*^9, 
   3.6467762954946947`*^9}, {3.646776521657631*^9, 3.6467765271529446`*^9}, {
   3.646776575518711*^9, 3.6467766262636137`*^9}, {3.646776931147052*^9, 
   3.6467769523662653`*^9}, {3.646777279436973*^9, 3.6467773051394434`*^9}, {
   3.646778384051153*^9, 3.6467784124807796`*^9}, {3.6467786201186557`*^9, 
   3.6467786317563214`*^9}, 3.6467786689284477`*^9, {3.6467788776043835`*^9, 
   3.646778877622384*^9}, {3.6467789355796995`*^9, 3.6467789355937*^9}, {
   3.6467793823112507`*^9, 3.6467794092197895`*^9}, {3.6467795109156065`*^9, 
   3.6467795380381575`*^9}, {3.646779594936412*^9, 3.6467796619742465`*^9}, {
   3.6467797222886963`*^9, 3.6467797497162647`*^9}, {3.6467797865613728`*^9, 
   3.6467797918526754`*^9}, 3.646780118812376*^9, 3.646780257158289*^9, {
   3.646781011114413*^9, 3.646781018473834*^9}, {3.6467873835118933`*^9, 
   3.6467874489706373`*^9}, {3.6467874993585196`*^9, 
   3.6467875600329895`*^9}, {3.6467876820879707`*^9, 3.6467876829440193`*^9}, 
   3.6467883739985456`*^9, {3.6467886337654037`*^9, 3.6467886355735073`*^9}, 
   3.6467889522636204`*^9, {3.646789112471784*^9, 3.64678911502093*^9}, {
   3.646789325319958*^9, 3.646789327342074*^9}, 3.6467896655394173`*^9, {
   3.646790031829368*^9, 3.6467900766299305`*^9}, 3.6467902406723137`*^9, 
   3.646790290839183*^9, {3.6467905173841405`*^9, 3.6467905203773117`*^9}, 
   3.6467906044731216`*^9, 3.6467907393258348`*^9, 3.6467957551817255`*^9, 
   3.646795922989323*^9, {3.646796247289872*^9, 3.6467962972227283`*^9}, 
   3.64679660426429*^9, 3.646797015209795*^9, {3.6468117434629645`*^9, 
   3.646811746789155*^9}, {3.646811891360424*^9, 3.6468118919514575`*^9}, {
   3.6468127013547525`*^9, 3.646812701680772*^9}, 3.646812734852669*^9, {
   3.6468128259828815`*^9, 3.6468128383635893`*^9}, {3.646812943438599*^9, 
   3.6468129621966724`*^9}, {3.646813061745366*^9, 3.646813070420862*^9}, {
   3.6468131083020287`*^9, 3.646813112480268*^9}, {3.6468131536536226`*^9, 
   3.6468132358883266`*^9}, {3.646813332591858*^9, 3.6468133762633553`*^9}, {
   3.6468134084121943`*^9, 3.6468134106423216`*^9}, {3.646813447117408*^9, 
   3.6468134555238886`*^9}, {3.6468135407217617`*^9, 3.646813630867918*^9}, 
   3.646813703146052*^9, 3.6468137493796964`*^9, 3.6468140892241344`*^9, {
   3.646814152036727*^9, 3.646814152630761*^9}, {3.646814725516528*^9, 
   3.6468147291327353`*^9}, {3.6468148263252945`*^9, 3.646814826650313*^9}, {
   3.646814924239895*^9, 3.646814987735526*^9}, {3.646815189432063*^9, 
   3.6468151957734256`*^9}, {3.646815229797372*^9, 3.6468154701141167`*^9}, {
   3.6468155237321835`*^9, 3.6468155345538025`*^9}, {3.6468155849706864`*^9, 
   3.646815590963029*^9}, {3.646815641264906*^9, 3.6468156425959826`*^9}, {
   3.6468157871832523`*^9, 3.6468158257044554`*^9}, {3.646816013822215*^9, 
   3.64681602142665*^9}, {3.646816348821376*^9, 3.6468163797511454`*^9}, {
   3.646816410943929*^9, 3.6468165114236765`*^9}, {3.6468165836958103`*^9, 
   3.646816621366965*^9}, {3.646816690957945*^9, 3.6468167041767015`*^9}, {
   3.6468168142069945`*^9, 3.646816816877147*^9}, 3.64681691710388*^9, {
   3.6468169522568903`*^9, 3.64681695276892*^9}, 3.6468169844467316`*^9, {
   3.6468173174857807`*^9, 3.6468173193128853`*^9}, 3.646817371115848*^9, {
   3.646817441716886*^9, 3.646817445671112*^9}, {3.646817490122655*^9, 
   3.646817517911244*^9}, {3.6468175749445066`*^9, 3.646817576839615*^9}, {
   3.646817614259755*^9, 3.646817616851903*^9}, {3.646817718689728*^9, 
   3.646817733955601*^9}, 3.646817790287823*^9, 3.6468179913543234`*^9, {
   3.6468191528927593`*^9, 3.646819163284354*^9}, 3.646821097006957*^9, {
   3.79892984752*^9, 3.798929859341*^9}, {3.798941208421*^9, 
   3.7989412353059998`*^9}, {3.798941421491*^9, 3.7989414259639997`*^9}, 
   3.798941471541*^9, {3.798942086775*^9, 3.798942119045*^9}, {
   3.798942341907*^9, 3.7989423622200003`*^9}, {3.798942474118*^9, 
   3.798942499335*^9}, {3.798942586035*^9, 3.798942606992*^9}, {
   3.798942705275*^9, 3.7989427600959997`*^9}, {3.798942850657*^9, 
   3.79894285746*^9}, {3.7989428955959997`*^9, 3.798942898014*^9}, {
   3.7989429474960003`*^9, 3.798943046433*^9}, {3.798943139567*^9, 
   3.798943153583*^9}, {3.798943241705*^9, 3.7989432768970003`*^9}, {
   3.798943350626*^9, 3.798943390123*^9}, {3.798943420468*^9, 
   3.798943425718*^9}, {3.799031638146*^9, 3.7990316409560003`*^9}, 
   3.7990316848269997`*^9, {3.799031873384*^9, 3.799031911513*^9}, {
   3.7990319445769997`*^9, 3.799032003645*^9}, {3.799032133163*^9, 
   3.799032150525*^9}, {3.7990321863859997`*^9, 3.799032217868*^9}, {
   3.799032272901*^9, 3.7990322767130003`*^9}, {3.7990323435810003`*^9, 
   3.79903234398*^9}, {3.799032537058*^9, 3.799032555584*^9}, {
   3.799032586667*^9, 3.799032594709*^9}, 3.799032632066*^9, {
   3.799032674106*^9, 3.799032674995*^9}, {3.799032720138*^9, 
   3.799032723791*^9}, {3.799032891334*^9, 3.79903294092*^9}, {
   3.7990329766940002`*^9, 3.799032989179*^9}, {3.799033071283*^9, 
   3.799033241402*^9}, {3.799033274532*^9, 3.7990332788529997`*^9}, {
   3.7990333948380003`*^9, 3.799033462833*^9}, 3.7990375461470003`*^9, {
   3.799037597958*^9, 3.79903780138*^9}, {3.7990387820109997`*^9, 
   3.799038782127*^9}, {3.799038880446*^9, 3.799038897094*^9}, {
   3.79903893521*^9, 3.7990389693129997`*^9}, {3.7991001458129997`*^9, 
   3.799100202236*^9}, {3.799100279343*^9, 3.799100405675*^9}, {
   3.799100535168*^9, 3.7991005688*^9}, {3.799100957648*^9, 
   3.799100966416*^9}, {3.7991012344890003`*^9, 3.799101253884*^9}, {
   3.799101364072*^9, 3.7991013742139997`*^9}, {3.799101547809*^9, 
   3.799101557704*^9}, {3.799101595883*^9, 3.79910159913*^9}, {
   3.7991016843929996`*^9, 3.799101689875*^9}, {3.799101754665*^9, 
   3.799101767459*^9}, {3.799101859085*^9, 3.799101886802*^9}, {
   3.799101976303*^9, 3.799102156417*^9}, {3.799102363375*^9, 
   3.799102422283*^9}, {3.7991025651800003`*^9, 3.79910259216*^9}, {
   3.799102653073*^9, 3.799102685453*^9}, 3.7991028072869997`*^9, 
   3.7991028468970003`*^9, 3.799103142859*^9, {3.799103173017*^9, 
   3.799103197071*^9}, {3.7991032701870003`*^9, 3.799103398637*^9}, 
   3.79910640004*^9, {3.79910643649*^9, 3.799106505186*^9}, {3.79910654787*^9,
    3.799106646054*^9}, 3.799106693967*^9, {3.799106869856*^9, 
   3.799106980889*^9}, {3.799107060796*^9, 3.7991070903789997`*^9}, 
   3.7991073224230003`*^9, {3.799107430204*^9, 3.799107452134*^9}, 
   3.799107537308*^9, 3.799107661231*^9, {3.799107734724*^9, 
   3.799107740612*^9}, {3.7991078357679996`*^9, 3.7991078359709997`*^9}, {
   3.799113518521*^9, 3.799113573574*^9}, {3.799113616243*^9, 
   3.799113618717*^9}, {3.799113751992*^9, 3.799113752259*^9}, {
   3.799113792727*^9, 3.7991138176949997`*^9}, 3.7991138659049997`*^9, {
   3.79911397479*^9, 3.79911401142*^9}, 3.799114076951*^9, {3.799114381966*^9,
    3.799114408433*^9}, {3.799114492262*^9, 3.79911455231*^9}, {
   3.799114674266*^9, 3.799114681718*^9}, {3.799114824153*^9, 
   3.799114827321*^9}, {3.799114994356*^9, 3.7991149946099997`*^9}, {
   3.799115035559*^9, 3.7991150391940002`*^9}, 3.799115080352*^9, {
   3.799115111718*^9, 3.799115115291*^9}, {3.799115184524*^9, 
   3.799115186468*^9}, {3.7991152614*^9, 3.799115263815*^9}, 
   3.799115486718*^9, {3.799116424484*^9, 3.799116457917*^9}, 
   3.7991168452869997`*^9, 3.799117087457*^9, {3.799117375986*^9, 
   3.7991174792209997`*^9}, {3.799117512038*^9, 3.799117583913*^9}, {
   3.799117614875*^9, 3.7991176243789997`*^9}, {3.7991176986809998`*^9, 
   3.799117713528*^9}, 3.799117825829*^9, 3.799118877324*^9, {
   3.799119775693*^9, 3.799119859672*^9}, {3.799120656387*^9, 
   3.799120657613*^9}, {3.799121310657*^9, 3.799121315683*^9}, 
   3.799121358756*^9, {3.799121991745*^9, 3.7991220088*^9}, {
   3.799125426852*^9, 3.799125441328*^9}, {3.7993565747980003`*^9, 
   3.7993565775179996`*^9}, {3.7993566235290003`*^9, 3.799356641804*^9}, 
   3.7993582337609997`*^9, 3.799359452067*^9, 3.799361126227*^9, {
   3.7993616296940002`*^9, 3.799361657641*^9}, {3.799363014282*^9, 
   3.799363030535*^9}, 3.79936476654*^9, 3.7993728096099997`*^9, {
   3.799384085633*^9, 3.7993840880810003`*^9}, {3.7993841274309998`*^9, 
   3.799384140349*^9}, {3.799384489051*^9, 3.799384515824*^9}, {
   3.799384636276*^9, 3.799384644032*^9}, 3.799387859741*^9, 
   3.799388446189*^9, {3.7994494239370003`*^9, 3.799449448072*^9}, {
   3.799449520769*^9, 3.7994495659709997`*^9}, {3.799449599334*^9, 
   3.7994498100030003`*^9}, {3.79944985735*^9, 3.799449861222*^9}, {
   3.799449939547*^9, 3.799449982882*^9}, {3.799450061385*^9, 
   3.799450095193*^9}, 3.799450151398*^9, {3.799450297748*^9, 
   3.79945030163*^9}, 3.799450503573*^9, 3.799450915868*^9, 
   3.7994510422460003`*^9, {3.7994512029700003`*^9, 3.799451214285*^9}, {
   3.799451349751*^9, 3.799451355972*^9}, 3.799451401414*^9, {
   3.79945163684*^9, 3.799451670994*^9}, 3.799451705116*^9, {
   3.799451735843*^9, 3.799451771751*^9}, 3.7994518944110003`*^9, {
   3.799460564513*^9, 3.7994605722390003`*^9}, {3.7994606046359997`*^9, 
   3.7994606293380003`*^9}, {3.799461900192*^9, 3.799461900703*^9}, {
   3.799461943229*^9, 3.799462002921*^9}, 3.799462749139*^9, {
   3.7994630828050003`*^9, 3.79946310217*^9}, {3.799466073616*^9, 
   3.799466079752*^9}, {3.799466498252*^9, 3.7994665080959997`*^9}, {
   3.7994668549230003`*^9, 3.799467062817*^9}, 3.799467449474*^9, 
   3.799467780061*^9, {3.7994683479440002`*^9, 3.7994683481730003`*^9}, 
   3.7994684196*^9, {3.79946871206*^9, 3.799468712391*^9}, {
   3.7994688116879997`*^9, 3.799468811835*^9}, 3.79946899285*^9, {
   3.799469031929*^9, 3.799469053292*^9}, 3.7994690964960003`*^9, {
   3.7994691466029997`*^9, 3.799469146689*^9}, {3.7994692450629997`*^9, 
   3.799469280724*^9}, {3.799469786316*^9, 3.799469809509*^9}, {
   3.7994699867139997`*^9, 3.799469990637*^9}, {3.799470134359*^9, 
   3.799470134677*^9}, {3.799470267391*^9, 3.799470277674*^9}, 
   3.799470484309*^9, {3.799470584664*^9, 3.799470585264*^9}, {
   3.799470684021*^9, 3.799470772516*^9}, 3.799470819258*^9, {
   3.799470851939*^9, 3.799470853458*^9}, {3.799470956208*^9, 
   3.799470959965*^9}, 3.799471030995*^9, {3.799471173108*^9, 
   3.79947121413*^9}, {3.7994713058129997`*^9, 3.7994713185880003`*^9}, {
   3.799471372684*^9, 3.799471375751*^9}, 3.7994715469709997`*^9, {
   3.79963194534*^9, 3.7996319456400003`*^9}, {3.799632041053*^9, 
   3.799632043616*^9}, 3.799632136523*^9, 3.799632562895*^9, 
   3.79963265769*^9, {3.799632923719*^9, 3.7996329313789997`*^9}, {
   3.799632969005*^9, 3.799632969244*^9}, 3.799633015682*^9, {
   3.799633300849*^9, 3.799633312987*^9}, 3.799633804106*^9, {
   3.799634324888*^9, 3.799634368403*^9}, 3.799636097804*^9, 
   3.799636179276*^9, 3.799638352949*^9, {3.799639722434*^9, 
   3.799639800282*^9}, {3.7996398425299997`*^9, 3.7996399173719997`*^9}, {
   3.7996399584709997`*^9, 3.7996400830039997`*^9}, {3.799640120942*^9, 
   3.799640131025*^9}, {3.799640485175*^9, 3.799640490058*^9}, {
   3.7996411069119997`*^9, 3.799641189863*^9}, {3.7996412654049997`*^9, 
   3.79964133196*^9}, {3.799642010885*^9, 3.79964201235*^9}, 
   3.799642841724*^9, {3.799643007299*^9, 3.799643008071*^9}, 
   3.7996441719*^9, {3.799644737356*^9, 3.799644745637*^9}, {3.79964577673*^9,
    3.799645778725*^9}, {3.79964683345*^9, 3.799646836348*^9}, {
   3.7996468973450003`*^9, 3.799646897782*^9}, 3.799647039924*^9, 
   3.7996472164890003`*^9, {3.7996473259630003`*^9, 3.7996473592939997`*^9}, 
   3.799647505135*^9, {3.799647950385*^9, 3.79964796609*^9}, {
   3.7996492863710003`*^9, 3.7996492892279997`*^9}, {3.799649596466*^9, 
   3.799649612296*^9}, 3.799699202685*^9, {3.799699332734*^9, 
   3.799699341627*^9}, {3.799699410558*^9, 3.7996994108129997`*^9}, {
   3.799699472051*^9, 3.7996994985039997`*^9}, {3.7996995423*^9, 
   3.799699575472*^9}, {3.799699606565*^9, 3.799699608023*^9}, 
   3.799699688382*^9, {3.799699938369*^9, 3.79969994015*^9}, {
   3.7997001462130003`*^9, 3.7997001570699997`*^9}, {3.79970087724*^9, 
   3.799700879196*^9}, {3.799700940829*^9, 3.799700943854*^9}, {
   3.799701005869*^9, 3.799701010795*^9}, {3.799701488138*^9, 
   3.799701488385*^9}, {3.799702031933*^9, 3.7997020841730003`*^9}, {
   3.7997026395039997`*^9, 3.799702690494*^9}, 3.7997027720699997`*^9, 
   3.799703632895*^9, 3.799719162936*^9, 3.79971921527*^9, 
   3.7997194060299997`*^9, {3.799719592973*^9, 3.799719593251*^9}, 
   3.799719669016*^9, {3.799720208707*^9, 3.7997202292679996`*^9}, 
   3.799720272383*^9, {3.799720556289*^9, 3.799720557821*^9}, {
   3.799724401224*^9, 3.799724404171*^9}, {3.7997248503199997`*^9, 
   3.7997248534*^9}, {3.799725212281*^9, 3.799725226826*^9}, {
   3.799725282991*^9, 3.799725287366*^9}, {3.7997253673199997`*^9, 
   3.7997253686029997`*^9}, {3.79972541873*^9, 3.7997254382799997`*^9}, {
   3.7997255715699997`*^9, 3.799725587241*^9}, 3.7997257179960003`*^9, 
   3.799725763542*^9, {3.79972602883*^9, 3.7997260374379997`*^9}, {
   3.799726257568*^9, 3.799726257866*^9}, {3.799726334355*^9, 
   3.7997263401280003`*^9}, {3.799726406113*^9, 3.799726406385*^9}, {
   3.799726462766*^9, 3.7997264629709997`*^9}, {3.799726721376*^9, 
   3.799726734865*^9}, {3.799726803392*^9, 3.799726806361*^9}, {
   3.7997274090810003`*^9, 3.799727415052*^9}, {3.799727585105*^9, 
   3.799727590234*^9}, 3.799727742958*^9, 3.7997278526219997`*^9, 
   3.7997283195369997`*^9, {3.799728914408*^9, 3.799728926999*^9}, {
   3.79979609726223*^9, 3.799796106389306*^9}, 3.799796536294338*^9, {
   3.7997972839737425`*^9, 3.79979728745849*^9}, 3.7997976835484104`*^9, 
   3.799800574905715*^9, {3.799802377425579*^9, 3.79980239268858*^9}, 
   3.799802892131135*^9, 3.7998037044509845`*^9, 3.7998051054913073`*^9, 
   3.7998054265332537`*^9, {3.799817262057745*^9, 3.7998172677872934`*^9}, 
   3.7998178618653674`*^9, 3.799964091859*^9, 3.79996427404*^9, {
   3.799964437104*^9, 3.799964442726*^9}, 3.799964542514*^9, 
   3.799964758259*^9, {3.799964963304*^9, 3.799964964068*^9}, 
   3.7999652082530003`*^9, {3.7999653450959997`*^9, 3.799965345455*^9}, {
   3.799965467898*^9, 3.7999655170620003`*^9}, {3.799965553528*^9, 
   3.7999655585150003`*^9}, {3.7999656605810003`*^9, 3.799965669803*^9}, {
   3.7999662575360003`*^9, 3.799966260133*^9}, {3.799966306325*^9, 
   3.799966307823*^9}, {3.7999667775369997`*^9, 3.799966789936*^9}, {
   3.7999670810690002`*^9, 3.799967114142*^9}, 3.799967145027*^9, {
   3.799967508942*^9, 3.799967541226*^9}, {3.7999676486809998`*^9, 
   3.799967649551*^9}, {3.799968024527*^9, 3.799968146752*^9}, {
   3.799968312443*^9, 3.799968313224*^9}, 3.799968356932*^9, {
   3.7999686020179996`*^9, 3.79996860445*^9}, {3.799968644009*^9, 
   3.79996864749*^9}, {3.799969106641*^9, 3.799969174918*^9}, {
   3.799969372707*^9, 3.799969385815*^9}, {3.799969679492*^9, 
   3.7999696817860003`*^9}, 3.799970097959*^9, 3.7999701289449997`*^9, 
   3.799970501192*^9, 3.799970826843*^9, 3.799979527067*^9, 
   3.7999799669849997`*^9, {3.799980354238*^9, 3.799980355043*^9}, {
   3.799982183335*^9, 3.799982187315*^9}, 3.799982894802*^9, 
   3.799983196691*^9, {3.799983433271*^9, 3.799983433568*^9}, 
   3.799983626512*^9, 3.7999837824969997`*^9, 3.7999914079119997`*^9, 
   3.7999914971400003`*^9, 3.799991898355*^9, {3.7999986939563727`*^9, 
   3.7999987134271035`*^9}},ExpressionUUID->"ecfe2c45-5511-4f85-b384-\
592fa2c1a148"]
}, Closed]],

Cell[CellGroupData[{

Cell[TextData[StyleBox["Main",
 FontWeight->"Bold",
 FontColor->RGBColor[1., 1., 1.]]], "Text",
 CellGroupingRules->{GroupTogetherGrouping, 10000.},
 CellChangeTimes->{
  3.6397942848343534`*^9, {3.6397943283110375`*^9, 3.6397943307450438`*^9}, {
   3.6397943837232227`*^9, 3.639794385839229*^9}, 3.6397944336894875`*^9, {
   3.639794855897752*^9, 3.639794885322799*^9}, {3.6397955409263296`*^9, 
   3.6397955626183686`*^9}, {3.639800404425104*^9, 3.6398004280832157`*^9}, 
   3.640907956913665*^9, {3.6409204558021493`*^9, 3.640920476494333*^9}, {
   3.640982614420762*^9, 3.640982614788783*^9}, {3.6412934381389723`*^9, 
   3.6412934480685406`*^9}, 3.6467372326504955`*^9},
 FontFamily->"Georgia",
 Background->GrayLevel[
  0],ExpressionUUID->"b5e17d60-bdbb-4327-8d94-548b6592eb97"],

Cell[CellGroupData[{

Cell[BoxData[{
 RowBox[{
  RowBox[{
   RowBox[{"{", 
    RowBox[{"dx", ",", "dy", ",", "d\[Theta]"}], "}"}], "=", 
   RowBox[{"{", 
    RowBox[{"0.05", ",", "0.05", ",", 
     RowBox[{"Pi", "/", "20."}]}], "}"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"startPose", "=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"-", "0.1"}], ",", "0.15", ",", "0"}], "}"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"goalPose", "=", 
   RowBox[{"{", 
    RowBox[{"0", ",", 
     RowBox[{"-", "0.7"}], ",", 
     RowBox[{"Pi", "/", "2"}]}], "}"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"father", "=", "0"}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"startnode", "=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"CalcIdx", "[", "startPose", "]"}], ",", "startPose", ",", 
     RowBox[{"{", 
      RowBox[{"0", ",", "0", ",", "0"}], "}"}], ",", 
     RowBox[{"{", "startPose", "}"}], ",", "father"}], "}"}]}], ";", 
  RowBox[{"(*", 
   RowBox[{"\:8282\:70b9\:5185\:5bb9", "\:ff1a", 
    RowBox[{"{", 
     RowBox[{
     "\:7d22\:5f15", "\:ff0c", 
      "\:8f68\:8ff9\:7247\:6bb5\:7684\:8d77\:70b9\:4f4d\:59ff", "\:ff0c", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{"f", ",", "g", ",", "h"}], "}"}], "\:51fd\:6570\:503c"}], 
      "\:ff0c", "\:8f68\:8ff9\:7247\:6bb5", "\:ff0c", 
      "\:7236\:8282\:70b9\:7684\:7d22\:5f15"}], "}"}]}], "*)"}], 
  "\[IndentingNewLine]", 
  RowBox[{"open", "=", 
   RowBox[{"{", "startnode", "}"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"closed", "=", 
   RowBox[{"{", "}"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"AbsoluteTiming", "[", 
   RowBox[{
    RowBox[{"Do", "[", 
     RowBox[{
      RowBox[{"extend", "[", "i", "]"}], " ", ",", 
      RowBox[{"{", 
       RowBox[{"i", ",", "2000"}], "}"}]}], "]"}], ";", " ", 
    RowBox[{"closed", "//", "Length"}]}], "]"}], " "}]}], "Input",
 CellChangeTimes->{{3.641437466899219*^9, 3.64143755241511*^9}, {
   3.64143774035786*^9, 3.641437789962697*^9}, 3.6414378473949823`*^9, {
   3.64143789211554*^9, 3.641438017891734*^9}, {3.641438079450255*^9, 
   3.6414381649161434`*^9}, {3.6414382245895567`*^9, 
   3.6414382828368883`*^9}, {3.6414384155014763`*^9, 3.641438477398016*^9}, {
   3.6414385699833117`*^9, 3.641438588588376*^9}, {3.6414386267855606`*^9, 
   3.641438670765076*^9}, 3.641438720708933*^9, {3.641438809354003*^9, 
   3.641438849621306*^9}, {3.6414389153500657`*^9, 3.6414389608056655`*^9}, {
   3.6414391092621565`*^9, 3.6414391369497404`*^9}, 3.641439182507346*^9, {
   3.6414392235036907`*^9, 3.6414392921996202`*^9}, 3.6414393490468717`*^9, {
   3.641439381387721*^9, 3.6414394323336353`*^9}, {3.641439553798583*^9, 
   3.6414395750197964`*^9}, {3.641439638265414*^9, 3.6414396582595577`*^9}, {
   3.641439772152072*^9, 3.641439790172103*^9}, 3.6414405211279106`*^9, {
   3.641440772457286*^9, 3.641440798733789*^9}, {3.641440864824569*^9, 
   3.6414408923121414`*^9}, 3.6414409762369413`*^9, {3.641441034066249*^9, 
   3.641441076440673*^9}, {3.641441116120942*^9, 3.6414411730021963`*^9}, {
   3.6467289443274307`*^9, 3.6467289564601245`*^9}, 3.6467291021034546`*^9, 
   3.6467291881983795`*^9, {3.6467292503809357`*^9, 3.6467292515090003`*^9}, {
   3.646729401837599*^9, 3.646729483109247*^9}, 3.646729760247099*^9, 
   3.6467299631417036`*^9, 3.6467301936938906`*^9, {3.6467303940033474`*^9, 
   3.646730394150356*^9}, {3.646730603294318*^9, 3.646730604710399*^9}, {
   3.6467321809375544`*^9, 3.64673218855599*^9}, {3.64673302234968*^9, 
   3.646733024146783*^9}, {3.6467330898405404`*^9, 3.6467330962789087`*^9}, 
   3.6467332502707167`*^9, 3.646733290504018*^9, {3.6467333328064375`*^9, 
   3.6467333420049634`*^9}, {3.646734092929914*^9, 3.6467340932949347`*^9}, 
   3.646734126729847*^9, {3.646734354612881*^9, 3.646734358835123*^9}, 
   3.646734470300498*^9, 3.646734539477455*^9, 3.6467348287650013`*^9, {
   3.6467350034739943`*^9, 3.6467350244811954`*^9}, {3.646735123813877*^9, 
   3.646735219429346*^9}, {3.6467355438549023`*^9, 3.646735549400219*^9}, {
   3.646735695892598*^9, 3.646735696179614*^9}, {3.646735749736678*^9, 
   3.646735749896687*^9}, {3.646735800342572*^9, 3.646735800444578*^9}, {
   3.646735854883692*^9, 3.646735855109705*^9}, {3.6467359914775047`*^9, 
   3.646735993913644*^9}, {3.6467360515549407`*^9, 3.6467360789085054`*^9}, {
   3.6467361326785808`*^9, 3.6467361352217264`*^9}, 3.646736482108567*^9, {
   3.6467365565418243`*^9, 3.646736558315926*^9}, 3.6467365930959153`*^9, 
   3.6467367192431307`*^9, {3.646736968679397*^9, 3.6467369738566933`*^9}, 
   3.646737103256095*^9, {3.646737457338347*^9, 3.646737458891436*^9}, {
   3.6467375795643377`*^9, 3.646737581978476*^9}, {3.646737808579437*^9, 
   3.6467378110765796`*^9}, {3.646776220198388*^9, 3.6467762203393965`*^9}, {
   3.6467764074460983`*^9, 3.6467764148865232`*^9}, {3.64677646902962*^9, 
   3.6467764691886296`*^9}, {3.646776538296582*^9, 3.646776545806012*^9}, 
   3.6467766367982163`*^9, {3.64677680733397*^9, 3.6467768140843563`*^9}, {
   3.6467768961560507`*^9, 3.6467769135630465`*^9}, {3.646777352556155*^9, 
   3.646777354718279*^9}, {3.646777404270113*^9, 3.646777477195284*^9}, {
   3.6467775709986496`*^9, 3.646777621935563*^9}, {3.646777692405594*^9, 
   3.6467776927896156`*^9}, {3.6467781293175836`*^9, 3.646778240673953*^9}, {
   3.64677885045183*^9, 3.6467788533419952`*^9}, 3.646778935506695*^9, 
   3.6467794433657427`*^9, 3.6467796681345987`*^9, {3.646779753792498*^9, 
   3.6467797544615364`*^9}, 3.646779897590723*^9, {3.646788022845461*^9, 
   3.646788029877863*^9}, 3.646788823366248*^9, {3.6467889039898596`*^9, 
   3.64678890732705*^9}, {3.646788963535265*^9, 3.6467890085438395`*^9}, {
   3.6467890908705482`*^9, 3.6467890911015615`*^9}, {3.6467891387342863`*^9, 
   3.6467891403653793`*^9}, {3.646789202501933*^9, 3.6467892038020077`*^9}, 
   3.6467893614070225`*^9, {3.646789414065034*^9, 3.6467894307679896`*^9}, {
   3.6467895434624352`*^9, 3.6467895517259083`*^9}, 3.6467896846945133`*^9, {
   3.6467900361206136`*^9, 3.6467900609980364`*^9}, 3.64679024812274*^9, 
   3.6467903062060614`*^9, {3.646790556903401*^9, 3.6467905572104187`*^9}, {
   3.6467906129826083`*^9, 3.646790650518755*^9}, {3.6467906826385927`*^9, 
   3.646790683906665*^9}, {3.6467907333414927`*^9, 3.6467907523665805`*^9}, {
   3.6467908087718067`*^9, 3.6467908595027084`*^9}, 3.646795865134014*^9, {
   3.646795958470353*^9, 3.6467959595724154`*^9}, {3.646796004985013*^9, 
   3.6467960053030314`*^9}, {3.6467960592481165`*^9, 3.646796087822751*^9}, 
   3.646796140287752*^9, 3.6467961750307393`*^9, 3.6467963314566865`*^9, {
   3.6467969216164417`*^9, 3.6467969221054697`*^9}, {3.646811178511651*^9, 
   3.646811187111143*^9}, 3.6468117306642323`*^9, 3.6468119102605047`*^9, {
   3.646813245062851*^9, 3.646813252783293*^9}, {3.6468134796072664`*^9, 
   3.6468135014055133`*^9}, {3.6468136106627626`*^9, 3.646813610834772*^9}, {
   3.646813642249569*^9, 3.6468136581934805`*^9}, {3.646813727784461*^9, 
   3.6468137280374756`*^9}, 3.646813764264548*^9, {3.6468137975114493`*^9, 
   3.646813797800466*^9}, 3.6468138858945045`*^9, 3.646813977113722*^9, {
   3.6468154820457993`*^9, 3.6468155086663218`*^9}, {3.6468156767629366`*^9, 
   3.6468156777259912`*^9}, 3.6468158770563927`*^9, 3.6468160294411087`*^9, {
   3.6468161506170397`*^9, 3.6468161643468246`*^9}, 3.646816389617709*^9, {
   3.64681653544005*^9, 3.646816544729581*^9}, 3.6468166680796366`*^9, 
   3.6468167630820704`*^9, {3.646816837151307*^9, 3.6468168738234043`*^9}, {
   3.64681753952748*^9, 3.646817565407961*^9}, {3.6468176474756546`*^9, 
   3.6468176478736773`*^9}, {3.646818081472478*^9, 3.646818100679577*^9}, {
   3.646818429583389*^9, 3.6468184619542403`*^9}, {3.6468187130236006`*^9, 
   3.646818727231413*^9}, 3.6468187698988533`*^9, {3.646819118295781*^9, 
   3.646819120565911*^9}, {3.646975360667539*^9, 3.6469753607975397`*^9}, 
   3.798929735743*^9, 3.798941239075*^9, {3.798942167552*^9, 
   3.7989421911689997`*^9}, {3.798942270889*^9, 3.79894230931*^9}, {
   3.799031924861*^9, 3.7990319296940002`*^9}, {3.799032020962*^9, 
   3.799032032717*^9}, {3.7990320985699997`*^9, 3.799032098799*^9}, 
   3.799032177159*^9, {3.7990323535559998`*^9, 3.799032416446*^9}, {
   3.799037833182*^9, 3.799037841441*^9}, {3.7991001587539997`*^9, 
   3.79910016002*^9}, {3.7991012868120003`*^9, 3.799101310106*^9}, {
   3.799101371519*^9, 3.79910137246*^9}, {3.799102469363*^9, 
   3.799102519598*^9}, 3.7991025524960003`*^9, {3.7991026985109997`*^9, 
   3.7991027078199997`*^9}, {3.799102741942*^9, 3.799102815043*^9}, 
   3.799103181983*^9, 3.7991034447200003`*^9, {3.799106663403*^9, 
   3.799106689546*^9}, {3.7991068515959997`*^9, 3.7991068620559998`*^9}, {
   3.7991070162790003`*^9, 3.7991070203710003`*^9}, {3.799107170701*^9, 
   3.799107193257*^9}, {3.799107260535*^9, 3.799107262427*^9}, 
   3.799107409843*^9, 3.7991074697679996`*^9, {3.7991075232609997`*^9, 
   3.799107552314*^9}, {3.799107698726*^9, 3.799107698914*^9}, {
   3.7991077755299997`*^9, 3.79910777927*^9}, {3.7991136447469997`*^9, 
   3.799113677618*^9}, {3.799113907407*^9, 3.799113911856*^9}, {
   3.799114396182*^9, 3.7991143973710003`*^9}, {3.7991144769969997`*^9, 
   3.7991144804560003`*^9}, {3.799115329837*^9, 3.7991153307790003`*^9}, {
   3.7991154031099997`*^9, 3.7991154041*^9}, 3.799115491002*^9, {
   3.79911647992*^9, 3.799116480427*^9}, 3.7991165487720003`*^9, 
   3.799116661608*^9, 3.799118317684*^9, {3.7991185497349997`*^9, 
   3.7991185530439997`*^9}, {3.7991191885290003`*^9, 3.799119188719*^9}, {
   3.799121371773*^9, 3.79912137513*^9}, {3.799122144224*^9, 
   3.799122145434*^9}, {3.7993582462530003`*^9, 3.799358246593*^9}, {
   3.799363038601*^9, 3.799363046322*^9}, {3.799372804763*^9, 
   3.799372804868*^9}, {3.799373063087*^9, 3.7993730632720003`*^9}, 
   3.799373309533*^9, {3.799373528535*^9, 3.799373530863*^9}, {
   3.7993755068129997`*^9, 3.799375508324*^9}, {3.799384159321*^9, 
   3.7993841635360003`*^9}, 3.799386160426*^9, {3.799387852884*^9, 
   3.7993878538310003`*^9}, 3.799387984568*^9, 3.799388177191*^9, {
   3.79938850804*^9, 3.799388509054*^9}, 3.7993888114820004`*^9, {
   3.799389465377*^9, 3.7993894673640003`*^9}, {3.799443735926*^9, 
   3.7994437397139997`*^9}, {3.7994444356289997`*^9, 3.799444438115*^9}, {
   3.79944533571*^9, 3.7994453389440002`*^9}, {3.799451064601*^9, 
   3.799451066006*^9}, {3.7994518173389997`*^9, 3.799451819024*^9}, {
   3.79946065405*^9, 3.7994606557279997`*^9}, 3.799461647606*^9, 
   3.799466463308*^9, 3.799466534024*^9, 3.799466619116*^9, 
   3.799467395341*^9, {3.79946754724*^9, 3.799467550074*^9}, {
   3.799468401683*^9, 3.799468402797*^9}, 3.799468758035*^9, 
   3.7994689953459997`*^9, {3.799469081783*^9, 3.799469083908*^9}, {
   3.799469665889*^9, 3.799469666009*^9}, 3.7994704267530003`*^9, {
   3.799470906856*^9, 3.799470909323*^9}, {3.7994710443529997`*^9, 
   3.79947105998*^9}, {3.7994711203380003`*^9, 3.7994711255690002`*^9}, 
   3.7994712311610003`*^9, 3.799471331422*^9, {3.799471443711*^9, 
   3.799471446751*^9}, {3.799631966966*^9, 3.799631970079*^9}, {
   3.7996320667130003`*^9, 3.79963208212*^9}, {3.7996338226429996`*^9, 
   3.799633828257*^9}, 3.799634030492*^9, 3.79964114983*^9, 
   3.7996412352390003`*^9, {3.799644055218*^9, 3.799644055639*^9}, {
   3.7996441640150003`*^9, 3.799644164484*^9}, {3.799646285712*^9, 
   3.799646300462*^9}, {3.799647027442*^9, 3.7996470297130003`*^9}, {
   3.799649307546*^9, 3.799649310243*^9}, 3.799649410561*^9, {
   3.799649499725*^9, 3.799649509856*^9}, {3.7996992128970003`*^9, 
   3.799699227841*^9}, {3.799699352149*^9, 3.799699356042*^9}, {
   3.799699431474*^9, 3.7996994527*^9}, 3.799699641159*^9, {3.79971918927*^9, 
   3.7997192024309998`*^9}, {3.799719395116*^9, 3.799719402449*^9}, {
   3.7997257572720003`*^9, 3.7997257574*^9}, 3.799725891513*^9, {
   3.799726793337*^9, 3.799726811574*^9}, 3.799727746137*^9, {
   3.799728824363*^9, 3.799728835583*^9}, {3.7997956844936657`*^9, 
   3.7997957319864635`*^9}, 3.799796110873978*^9, 3.799796540177948*^9, {
   3.7997977143351707`*^9, 3.7997977577002745`*^9}, {3.7997983859654818`*^9, 
   3.799798449764896*^9}, 3.799800567849024*^9, 3.7998044395113025`*^9, {
   3.79996352717*^9, 3.799963540804*^9}, 3.7999636626879997`*^9, 
   3.7999637964370003`*^9, 3.799963932658*^9, 3.799964506086*^9, {
   3.799964752942*^9, 3.799964753197*^9}, 3.799964967591*^9, {
   3.799965566894*^9, 3.799965567156*^9}, {3.799967571293*^9, 
   3.799967571543*^9}, 3.7999685837939997`*^9, 3.799969756737*^9, {
   3.79997083027*^9, 3.799970831083*^9}, 3.799971030509*^9, 3.799979894907*^9,
    3.799980656157*^9, 3.799981204311*^9, {3.799981855868*^9, 
   3.7999818590959997`*^9}, 3.7999821833459997`*^9, {3.799982503392*^9, 
   3.799982509882*^9}, {3.799990250157*^9, 3.799990295191*^9}, {
   3.799990342531*^9, 3.7999903776210003`*^9}, 3.799990419767*^9, {
   3.7999905153269997`*^9, 3.7999905507200003`*^9}, 3.799990856763*^9, 
   3.799990931145*^9, 3.7999915237790003`*^9, {3.799991715132*^9, 
   3.799991747671*^9}, 3.7999918791540003`*^9, 3.799992052442*^9, 
   3.7999925488599997`*^9, {3.7999987322569633`*^9, 
   3.799998825027583*^9}},ExpressionUUID->"4cbfaf78-f0e2-4fc6-baaf-\
6434638a38d5"],

Cell[BoxData["\<\"Goal Reached!\"\>"], "Print",
 CellChangeTimes->{3.799991781901*^9, 3.79999202812*^9, 
  3.7999924709049997`*^9, 3.799992767692*^9},
 CellLabel->
  "\:6b63\:5728\:8ba1\:7b97In[858]:=",ExpressionUUID->"616c34c3-119c-4eed-\
843f-9d3307d628b3"],

Cell[BoxData[
 RowBox[{"{", 
  RowBox[{"211.4125880597221`", ",", "645"}], "}"}]], "Output",
 CellChangeTimes->{3.799991781903*^9, 3.7999920281219997`*^9, 
  3.799992470907*^9, 3.7999927676940002`*^9},
 CellLabel->
  "Out[865]=",ExpressionUUID->"5c4dd160-910f-48e9-82f8-975f4bb3475c"]
}, Open  ]]
}, Closed]],

Cell[CellGroupData[{

Cell[TextData[StyleBox["Graphics",
 FontWeight->"Bold",
 FontColor->RGBColor[1., 1., 1.]]], "Text",
 CellGroupingRules->{GroupTogetherGrouping, 10000.},
 CellChangeTimes->{
  3.6397942848343534`*^9, {3.6397943283110375`*^9, 3.6397943307450438`*^9}, {
   3.6397943837232227`*^9, 3.639794385839229*^9}, 3.6397944336894875`*^9, {
   3.639794855897752*^9, 3.639794885322799*^9}, {3.6397955409263296`*^9, 
   3.6397955626183686`*^9}, {3.639800404425104*^9, 3.6398004280832157`*^9}, 
   3.640907956913665*^9, {3.6409204558021493`*^9, 3.640920476494333*^9}, {
   3.640982614420762*^9, 3.640982614788783*^9}, {3.6412934381389723`*^9, 
   3.6412934480685406`*^9}, {3.646737242506059*^9, 3.6467372447061853`*^9}},
 FontFamily->"Georgia",
 Background->GrayLevel[
  0],ExpressionUUID->"672bff74-d3a0-47e5-8003-1e0cfb1c3256"],

Cell[BoxData[{
 RowBox[{
  RowBox[{"interposes", "=", 
   RowBox[{"backTrack", "[", "]"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"arcs", "=", 
   RowBox[{"closed", "\[LeftDoubleBracket]", 
    RowBox[{";;", ",", 
     RowBox[{"-", "2"}]}], "\[RightDoubleBracket]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"Graphics3D", "[", 
   RowBox[{
    RowBox[{"{", 
     RowBox[{
      RowBox[{"Thickness", "[", "0.001", "]"}], ",", 
      RowBox[{"Table", "[", 
       RowBox[{
        RowBox[{"Line", "[", 
         RowBox[{
          RowBox[{
           RowBox[{
            RowBox[{"{", 
             RowBox[{"1", ",", "1", ",", "0.1"}], "}"}], "*", "#"}], "&"}], "/@",
           "arc"}], "]"}], ",", 
        RowBox[{"{", 
         RowBox[{"arc", ",", "arcs"}], "}"}]}], "]"}]}], "}"}], ",", 
    RowBox[{"PlotRange", "\[Rule]", 
     RowBox[{"{", 
      RowBox[{
       RowBox[{"{", 
        RowBox[{
         RowBox[{"-", "1"}], ",", "1"}], "}"}], ",", 
       RowBox[{"{", 
        RowBox[{
         RowBox[{"-", "1"}], ",", "1"}], "}"}], ",", 
       RowBox[{
        RowBox[{"{", 
         RowBox[{
          RowBox[{"-", "1"}], ",", "1"}], "}"}], "0.1", "Pi"}]}], "}"}]}], 
    ",", 
    RowBox[{"ImageSize", "\[Rule]", "800"}], ",", 
    RowBox[{"Axes", "\[Rule]", "True"}]}], "]"}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"drawPoseArrow", "[", "pose_", "]"}], ":=", 
   RowBox[{"{", 
    RowBox[{
     RowBox[{"Arrowheads", "[", "0.006", "]"}], ",", 
     RowBox[{"Thickness", "[", "0.0014", "]"}], ",", 
     RowBox[{"Arrow", "[", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"pose", "\[LeftDoubleBracket]", 
         RowBox[{"1", ";;", "2"}], "\[RightDoubleBracket]"}], ",", 
        RowBox[{
         RowBox[{"pose", "\[LeftDoubleBracket]", 
          RowBox[{"1", ";;", "2"}], "\[RightDoubleBracket]"}], "+", 
         RowBox[{"0.05", 
          RowBox[{"AngleVector", "[", 
           RowBox[{
           "pose", "\[LeftDoubleBracket]", "3", "\[RightDoubleBracket]"}], 
           "]"}]}]}]}], "}"}], "]"}]}], "}"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{"Graphics", "[", 
  RowBox[{
   RowBox[{"{", 
    RowBox[{"Orange", ",", 
     RowBox[{"Thickness", "[", "0.0006", "]"}], ",", 
     RowBox[{"Line", "/@", 
      RowBox[{"(", 
       RowBox[{"closed", "\[LeftDoubleBracket]", 
        RowBox[{";;", ",", 
         RowBox[{"-", "2"}], ",", ";;", ",", 
         RowBox[{"1", ";;", "2"}]}], "\[RightDoubleBracket]"}], ")"}]}], ",", 
     RowBox[{"FaceForm", "[", "]"}], ",", 
     RowBox[{"EdgeForm", "[", 
      RowBox[{"{", 
       RowBox[{
        RowBox[{"Lighter", "@", "Black"}], ",", 
        RowBox[{"Thickness", "[", "0.0006", "]"}]}], "}"}], "]"}], ",", 
     RowBox[{
      RowBox[{
       RowBox[{"Polygon", "[", 
        RowBox[{"carCorner", "[", "#", "]"}], "]"}], "&"}], "/@", 
      "interposes"}], ",", "Red", ",", 
     RowBox[{"drawPoseArrow", "[", "startPose", "]"}], ",", "Green", ",", 
     RowBox[{"drawPoseArrow", "[", "goalPose", "]"}], ",", 
     RowBox[{"FaceForm", "[", "LightBlue", "]"}], ",", 
     RowBox[{"EdgeForm", "[", "Blue", "]"}], ",", "obstaclesRegion"}], "}"}], 
   ",", 
   RowBox[{"PlotRange", "\[Rule]", "1"}], ",", 
   RowBox[{"Axes", "\[Rule]", "True"}], ",", 
   RowBox[{"GridLines", "\[Rule]", 
    RowBox[{"{", 
     RowBox[{
      RowBox[{"Range", "[", 
       RowBox[{
        RowBox[{"-", "1"}], ",", "1", ",", "dx"}], "]"}], ",", 
      RowBox[{"Range", "[", 
       RowBox[{
        RowBox[{"-", "1"}], ",", "1", ",", "dy"}], "]"}]}], "}"}]}], ",", 
   RowBox[{"ImageSize", "\[Rule]", "800"}], ",", 
   RowBox[{"Method", "\[Rule]", 
    RowBox[{"{", 
     RowBox[{"\"\<AxesInFront\>\"", "\[Rule]", "False"}], "}"}]}]}], 
  "]"}]}], "Input",
 CellChangeTimes->{{3.7991070981280003`*^9, 3.799107154289*^9}, {
   3.7991072133129997`*^9, 3.799107237954*^9}, {3.799107683811*^9, 
   3.799107690608*^9}, {3.799113698625*^9, 3.799113737808*^9}, 
   3.7991139303640003`*^9, {3.799114156519*^9, 3.799114198988*^9}, {
   3.799114316741*^9, 3.799114324406*^9}, {3.7991146217980003`*^9, 
   3.799114636334*^9}, {3.799114757241*^9, 3.79911479115*^9}, {
   3.799114840716*^9, 3.799114900474*^9}, 3.7991152468389997`*^9, {
   3.799115448066*^9, 3.799115448133*^9}, {3.799115515416*^9, 
   3.7991155400039997`*^9}, {3.799116535377*^9, 3.7991165356689997`*^9}, {
   3.799117025325*^9, 3.7991170535030003`*^9}, {3.7991174692539997`*^9, 
   3.7991174857650003`*^9}, {3.799117745072*^9, 3.799117767508*^9}, {
   3.799118138913*^9, 3.799118140085*^9}, {3.799118505705*^9, 
   3.7991185128450003`*^9}, 3.799451009074*^9, {3.799451756111*^9, 
   3.799451757704*^9}, {3.799461739826*^9, 3.7994618494639997`*^9}, {
   3.799462497111*^9, 3.799462507244*^9}, 3.799462776226*^9, {
   3.79946406301*^9, 3.7994640650030003`*^9}, {3.799466212953*^9, 
   3.799466213834*^9}, 3.799466644951*^9, 3.79946919235*^9, 
   3.799469290167*^9, {3.799633976352*^9, 3.799634008521*^9}, {
   3.799634701988*^9, 3.7996347083310003`*^9}, 3.79963483313*^9, {
   3.799634953531*^9, 3.799634986788*^9}, {3.79963532588*^9, 
   3.799635358242*^9}, 3.799638342658*^9, {3.799639810205*^9, 
   3.7996398272939997`*^9}, {3.799644195052*^9, 3.7996441956940002`*^9}, {
   3.799644525425*^9, 3.7996445296140003`*^9}, {3.799644760087*^9, 
   3.799644760814*^9}, {3.799646718285*^9, 3.799646721007*^9}, 
   3.799647108744*^9, {3.799649369756*^9, 3.799649378848*^9}, {
   3.799700721415*^9, 3.799700771156*^9}, 3.799721539889*^9, 
   3.7997234692139997`*^9, {3.799723551644*^9, 3.799723551883*^9}, {
   3.7997237287650003`*^9, 3.799723748229*^9}, {3.799724388222*^9, 
   3.799724389001*^9}, 3.799724509668*^9, 3.7997248090150003`*^9, 
   3.799726152189*^9, {3.7997261895769997`*^9, 3.7997261921429996`*^9}, 
   3.799726996026*^9, {3.799727063448*^9, 3.799727064258*^9}, 
   3.799728766876*^9, {3.799728882384*^9, 3.799728893873*^9}, {
   3.7997955328216257`*^9, 3.7997955388049946`*^9}, 3.7997956941510844`*^9, {
   3.799964705709*^9, 3.799964720705*^9}, 3.7999648472200003`*^9, {
   3.799970069668*^9, 3.799970072434*^9}, {3.799970484137*^9, 
   3.799970489041*^9}, 3.799979928774*^9, 3.7999799727390003`*^9, {
   3.799980673993*^9, 3.799980675784*^9}, {3.799981493193*^9, 
   3.799981495002*^9}},
 CellLabel->
  "In[866]:=",ExpressionUUID->"9356778a-547a-4f0d-a157-cccdcfe9e20a"],

Cell[BoxData[{
 RowBox[{
  RowBox[{"interposes", "=", 
   RowBox[{"backTrack", "[", "]"}]}], ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{
   RowBox[{"frame", "[", "i_", "]"}], ":=", 
   RowBox[{"Graphics", "[", 
    RowBox[{
     RowBox[{"{", "\[IndentingNewLine]", 
      RowBox[{
       RowBox[{"FaceForm", "[", "]"}], ",", 
       RowBox[{"EdgeForm", "[", 
        RowBox[{"{", 
         RowBox[{"Green", ",", 
          RowBox[{"Thickness", "[", "0.001", "]"}]}], "}"}], "]"}], ",", 
       RowBox[{"Polygon", "[", 
        RowBox[{"carCorner", "[", "goalPose", "]"}], "]"}], ",", 
       "\[IndentingNewLine]", 
       RowBox[{"FaceForm", "[", "]"}], ",", 
       RowBox[{"EdgeForm", "[", 
        RowBox[{"{", 
         RowBox[{
          RowBox[{"Lighter", "@", "Gray"}], ",", 
          RowBox[{"Thickness", "[", "0.001", "]"}]}], "}"}], "]"}], ",", 
       RowBox[{
        RowBox[{
         RowBox[{"Polygon", "[", 
          RowBox[{"carCorner", "[", "#", "]"}], "]"}], "&"}], "/@", 
        RowBox[{"interposes", "\[LeftDoubleBracket]", 
         RowBox[{"1", ";;", "i", ";;", "1"}], "\[RightDoubleBracket]"}]}], 
       ",", 
       RowBox[{"EdgeForm", "[", 
        RowBox[{"{", 
         RowBox[{"Black", ",", 
          RowBox[{"Thickness", "[", "0.002", "]"}]}], "}"}], "]"}], ",", 
       RowBox[{"Polygon", "[", 
        RowBox[{"carCorner", "[", 
         RowBox[{
         "interposes", "\[LeftDoubleBracket]", "i", "\[RightDoubleBracket]"}],
          "]"}], "]"}], ",", 
       RowBox[{"FaceForm", "[", "LightBlue", "]"}], ",", 
       RowBox[{"EdgeForm", "[", 
        RowBox[{"{", 
         RowBox[{"Blue", ",", 
          RowBox[{"Thickness", "[", "0.002", "]"}]}], "}"}], "]"}], ",", 
       "obstaclesRegion"}], "}"}], ",", 
     RowBox[{"PlotRange", "\[Rule]", "1"}], ",", 
     RowBox[{"Axes", "\[Rule]", "False"}], ",", 
     RowBox[{"ImageSize", "\[Rule]", "700"}]}], "]"}]}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"Manipulate", "[", 
   RowBox[{
    RowBox[{"frame", "[", "i", "]"}], ",", 
    RowBox[{"{", 
     RowBox[{"i", ",", "1", ",", 
      RowBox[{"Length", "[", "interposes", "]"}], ",", "1"}], "}"}]}], "]"}], 
  ";"}], "\[IndentingNewLine]", 
 RowBox[{
  RowBox[{"Export", "[", 
   RowBox[{"\"\<C:\\\\1.gif\>\"", ",", 
    RowBox[{"frame", "/@", 
     RowBox[{"Range", "[", 
      RowBox[{"Length", "[", "interposes", "]"}], "]"}]}]}], "]"}], 
  ";"}]}], "Input",
 CellChangeTimes->{{3.7996350034820004`*^9, 3.7996350974700003`*^9}, {
   3.799635153384*^9, 3.799635174568*^9}, {3.799635373723*^9, 
   3.79963540921*^9}, {3.7996355176099997`*^9, 3.7996355361940002`*^9}, {
   3.7996398307860003`*^9, 3.79963983298*^9}, {3.799646645626*^9, 
   3.799646671427*^9}, {3.7997953899651537`*^9, 3.7997954301194153`*^9}, {
   3.799795529633127*^9, 3.7997956408111877`*^9}, 3.7997975514663725`*^9, 
   3.799797731561582*^9, {3.7998035476631827`*^9, 3.7998035548548408`*^9}, 
   3.799964416737*^9, {3.799966486976*^9, 3.799966636682*^9}, {
   3.799966844348*^9, 3.79996685233*^9}, {3.7999815131359997`*^9, 
   3.799981513656*^9}, {3.799983966361*^9, 3.799983978847*^9}, {
   3.799990446953*^9, 3.799990451641*^9}, {3.799992794078*^9, 
   3.7999928482869997`*^9}},
 CellLabel->
  "In[889]:=",ExpressionUUID->"196c5b03-dfa5-4277-85d9-84dae6c1fee1"]
}, Closed]]
},
CellGrouping->Manual,
WindowSize->{3840, 1915},
WindowMargins->{{-18, Automatic}, {Automatic, -18}},
Magnification:>1.45 Inherited,
FrontEndVersion->"12.0 for Microsoft Windows (64-bit) (2019\:5e744\:67088\
\:65e5)",
StyleDefinitions->"Default.nb"
]
(* End of Notebook Content *)

(* Internal cache information *)
(*CellTagsOutline
CellTagsIndex->{}
*)
(*CellTagsIndex
CellTagsIndex->{}
*)
(*NotebookFileOutline
Notebook[{
Cell[CellGroupData[{
Cell[580, 22, 832, 14, 141, "Program",ExpressionUUID->"cc01d7c5-e572-44e0-b156-551deced11ce",
 CellGroupingRules->{"GroupTogetherGrouping", 10000.}],
Cell[1415, 38, 150618, 3686, 26145, "Input",ExpressionUUID->"1a645e91-d74d-43c2-9ae2-8fd8592d98e2",
 CellGroupingRules->{"GroupTogetherGrouping", 10000.}]
}, Closed]],
Cell[CellGroupData[{
Cell[152070, 3729, 830, 14, 115, "Text",ExpressionUUID->"df1762ea-06ad-4365-b881-a6cf262212f1",
 CellGroupingRules->{GroupTogetherGrouping, 10000.}],
Cell[152903, 3745, 7438, 217, 629, "Input",ExpressionUUID->"2a5c3f71-ad30-4350-838b-96353f7ba81f"],
Cell[160344, 3964, 1184, 27, 163, "Input",ExpressionUUID->"4973a056-0bb7-4dec-b287-338ea256b275"],
Cell[161531, 3993, 3570, 96, 279, "Input",ExpressionUUID->"4ed375e7-40fa-4a7f-841a-c2fb517a2870"]
}, Closed]],
Cell[CellGroupData[{
Cell[165138, 4094, 811, 14, 115, "Text",ExpressionUUID->"b6695ca9-8cfc-4e5c-8e0c-f575e2dc8557",
 CellGroupingRules->{GroupTogetherGrouping, 10000.}],
Cell[165952, 4110, 36747, 705, 3576, "Input",ExpressionUUID->"ecfe2c45-5511-4f85-b384-592fa2c1a148"]
}, Closed]],
Cell[CellGroupData[{
Cell[202736, 4820, 784, 14, 115, "Text",ExpressionUUID->"b5e17d60-bdbb-4327-8d94-548b6592eb97",
 CellGroupingRules->{GroupTogetherGrouping, 10000.}],
Cell[CellGroupData[{
Cell[203545, 4838, 13211, 214, 437, "Input",ExpressionUUID->"4cbfaf78-f0e2-4fc6-baaf-6434638a38d5"],
Cell[216759, 5054, 259, 5, 61, "Print",ExpressionUUID->"616c34c3-119c-4eed-843f-9d3307d628b3"],
Cell[217021, 5061, 284, 6, 124, "Output",ExpressionUUID->"5c4dd160-910f-48e9-82f8-975f4bb3475c"]
}, Open  ]]
}, Closed]],
Cell[CellGroupData[{
Cell[217354, 5073, 812, 14, 115, "Text",ExpressionUUID->"672bff74-d3a0-47e5-8003-1e0cfb1c3256",
 CellGroupingRules->{GroupTogetherGrouping, 10000.}],
Cell[218169, 5089, 6354, 146, 413, "Input",ExpressionUUID->"9356778a-547a-4f0d-a157-cccdcfe9e20a"],
Cell[224526, 5237, 3302, 79, 413, "Input",ExpressionUUID->"196c5b03-dfa5-4277-85d9-84dae6c1fee1"]
}, Closed]]
}
]
*)

